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Description 

Technical Field 

5 [0001] The present invention relates to a gait generation device for a legged mobile robot. 
Background Art 

[0002] In Japanese Patent Application No. 2000-352011 . the applicants have proposed a technique of using a rel- 
10 atively simple robot dynamics model to generate in real time a flexible gait (referred to as an approximate gait, here- 
inafter) with which a robot can continuously move while approximately satisfying its dynamical equilibrium condition (i. 
e., without divergence). 

[0003] Furthermore, in Japanese Patent Application No. 2001 -1 33621 , there is proposed a technique of generating 
a gait that is corrected so as to precisely satisfy the dynamical equilibrium condition and substantially follow the ap- 
15 proximate gait without divergence. A desired gait corrected is referred to as a corrected desired gait or a corrected 
gait, hereinafter. 

[0004] However, in Japanese Patent Application No. 2001-133621 , a desired floor reaction force, which has been 
appropriately determined, is shifted to prevent divergence of the corrected gait. That is, the floor reaction force is 
modified so that a floor reaction force moment is produced (acted) about a desired ZMP, which has been appropriately 

20 determined, or the desired ZMP itself is modified. 

[0005] In the following, the appropriately determined desired floor reaction force is referred to as an ideal desired 
fioor reaction force ; and the appropriately determined desired ZMP is referred to as an ideal desired ZMP. 
[0006] As shown in the following formula, a shift of the desired ZMP from the ideal desired ZMP is equivalent to 
production of a floor reaction force moment about the ideal desired ZMP which is expressed as (shift of the desired 

25 ZMP) * (vertical component of the translation floor reaction force). 

(floor reaction force moment about the ideal desired ZMP) 
30 = (shift of the desired ZMP) * (vertical component of the 

translation force of the floor reaction force) formula b01 

[0007] In the following, the vertical component of the translation floor reaction force is sometimes abbreviated as a 
35 floor reaction force vertical component as far as it is not misconstrued as the floor reaction force moment about the 
vertical axis. 

[0008] To what extent the divergence of the corrected gait can be prevented and the corrected gait can be stabilized 
depends on the maximum value (minimum value) of the floor reaction force moment that can be produced about the 
ideal desired ZMP. 

40 [0009] When a robot walks, the floor reaction force vertical component is always substantially equal to the weight of 
the robot, and the possible area of the desired ZMP (a minimum polygon surrounding the contact surface, referred 
also to as a supporting polygon) is wide. Thus, divergence of the corrected gait can be prevented by shifting the desired 
ZMP within the possible area and thereby producing a floor reaction force moment about the ideal desired ZMP. 
[0010] On the other hand, when a robot runs, all the legs of the robot may often float in the air, and in such a state, 
the floor reaction force vertical component is 0. In this state, all the components of the floor reaction force (the com- 
ponents of the translation force and the moment) are typically 0. Therefore, when all the legs float in the air. divergence 
of the corrected gait cannot be prevented by producing a floor reaction force moment about the ideal desired ZMR 
[0011] Even if any of the legs is in contact with the floor, if the floor reaction force vertical component is close to 0, 
only a slight floor reaction force moment about the ideal desired ZMP can be produced by shifting the desired ZMP 
so within the possible area of the desired ZMP. This is because the moment about the ideal desired ZMP is a product of 
the amount of the modification of the desired ZM P and the floor reaction force vertical component, as described above. 
Therefore, in this case also, divergence of the corrected gait cannot be prevented. 

[0012] As described above, when the floor reaction force vertical component is 0 or close to 0, the absolute value 
of the floor reaction force moment that can be produced about the ideal desired ZMP is small, and therefore, divergence 
55 of the corrected gait cannot be prevented. Thus, the corrected gait has to be brought close to the approximate gait 
when the floor reaction force vertical component has an adequate value. 

[0013] Besides, if a foot sole of the robot is in contact with the floor and an adhesion force (attraction force) can be 
produced between the sole and the floor, a floor reaction force moment can be produced even if the floor reaction force 
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vertical component is 0. However in general, legged mobile robots are controlled on the assumption that there is no 
adhesion force (attraction force). In addition, in usual operating environments of such robots, substantially no adhesion 
force occurs between the floor and the foot soles. 

[0014] In addition, if the floor reaction force vertical component is 0, the desired ZMP is not settled and can be set 
5 at any point. However, all the components of the floor reaction force are 0, and therefore, if the desired ZMP is shifted, 
any floor reaction force moment cannot be produced about the ideal desired ZMP. 

[0015] Another important problem which is not specifically described in Japanese Patent Application No. 
2001-133621 is of slipping. 

[0016] In the embodiments described in Japanese Patent Application No. 2001-133621, the body horizontal accel- 
10 eration for the corrected gait is adjusted (changed) in such a manner that the moment produced about the original 
desired ZMP by the resultant of gravity and the inertial force produced by the movement of the robot is reduced to 0 
or made to agree with the floor reaction force moment for preventing divergence of the corrected gait (full-model cor- 
rected moment about the desired ZMP described in Japanese Patent Application No. 2001-133621) as described 
above. In other words, the total center- of- gravity horizontal acceleration is adjusted (changed). As a result, the floor 
15 reaction force horizontal component in balance with the total center- of- gravity horizontal acceleration changes. 

[0017] In the case where the robot moves on a horizontal floor surface, the floor reaction force horizontal component 
is caused by friction. 

[0018] When the robot walks on a floor surface having a high friction coefficient, the floor reaction force vertical 
component is always substantially equal to the weight thereof, and therefore, the friction force (that is, the floor reaction 
20 force horizontal component) has a high limit value. Thus, the robot hardly slips even if the body horizontal acceleration 
for the corrected gait is changed as described above. 

[0019] On the other hand, when the robot walks on a floor surface having a low friction coefficient, the limit value of 
the friction force (the floor reaction force horizontal component) is low. Therefore, when the body horizontal acceleration 
for the corrected gait is changed as described above, a floor reaction force horizontal component that is in balance 

25 therewith cannot be produced, and thus, the robot may slip. 

[0020] During running, the floor reaction force vertical component sometimes becomes approximately 0, When this 
occurs, even if the floor surface has a high friction coefficient, the limit value of the friction force (the floor reaction force 
horizontal component) is substantially 0. Thus, during running also, the robot may slip if the body horizontal acceleration 
for the corrected gait is changed as described above. 

30 [0021] in addition, during running, the floor reaction force vertical component sometimes becomes 0 (when both the 
legs float in the air). When this occurs, the friction force (the floor reaction force horizontal component) also becomes 
0, so that the total center-of-gravity horizontal acceleration is naturally 0 (uniform motion). In other words, the gait of 
the robot has to be one in which the total center-of-gravity horizontal acceleration is 0. 

[0022] As described above, in the cases where the robot runs and where the robot walks on a floor surface of a low 
35 friction coefficient, it is difficult or possibly impossible thai the body horizontal acceleration for the corrected gait (or the 
total center-of-gravity horizontal acceleration) is adjusted (changed) in such a manner that the moment produced about 
the ideal desired ZMP by the resultant of gravity and the inertial force is reduced to 0 or made to agree with the floor 
reaction force moment for preventing divergence of the corrected gait as described above. 

[0023] In consideration of cases where a robot runs or walks on_a floor surface of a low friction coefficient, the 
40 applicants have proposed a technique of explicitly setting a desired ZM P trajectory, a desired floor reaction force vertical 
component traj ectory and an allowable range for the floor reaction force horizontal component and generating a move- 
ment of a gait (foot position/posture trajectory and body position/posture trajectory) in which the desired floor reaction 
force ZMP trajectory and the desired floor reaction force vertical component trajectory are satisfied, and the floor re- 
action force horizontal component falls within the allowable range for the floor reaction force horizontal component. 
45 [0024] According to this technique, with a precise dynamics model, the dynamical equilibrium condition (the moment 
produced about the desired ZMP by the resultant of gravity and the inertial force is 0) can be precisely satisfied and 
the floor reaction force horizontal component can be made to always fall within allowable range for the floor reaction 
force horizontal component. However such a precise dynamics model requires more calculation for solving equations 
of motion. In addition, such a precise dynamics model has a strong nonlinearity. Therefore, when searching for a gait 
50 parameter that satisfies a normal gait boundary requirement (that equal body position/velocity is provided at the start 
and end of the gait, for example) described in Japanese Patent Application No. 2000-352011 previously proposed by 
the applicants, that is, a gait parameter that enables the robot to continuously move stably, the convergence coefficient 
is reduced and the number of searchings increases. Thus, the total calculation amount is enormous, so that a high- 
speed computer or a dedicated IC for dynamics model calculation is required. In addition, it is difficult to generate a 
gait in real time when the robot is moving. 

[0025] However, with a simple approximate dynamics model, there arise problems that the dynamical equilibrium 
condition cannot be satisfied with an adequate precision although the amount of calculation is reduced, the ZMP of 
the actually generated gait is out of the possible area thereof, or the floor reaction force horizontal component is out 
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of the allowable range of the floor reaction force horizontal component (friction force limit), for example. Thus, there is 
a high possibility that an actual robot moves unstably or slips when it is made to move by following the generated gait. 
[0026] Therefore, an object of the present invention is to overcome the disadvantages of the techniques previously 
proposed and provide a gait generation device that can generate various desired gaits for normal walking as well as 
5 running, walking on a floor surface of a low friction coefficient and the like with a relatively small amount of calculation. 
In addition, an object of the present invention is to provide a gait generation device that can generate a gait that precisely 
satisfies the dynamical equilibrium condition with the ZMP, the floor reaction force horizontal component or the like 
falling within appropriate allowable ranges. 

10 Disclosure of the Invention 

[0027] According to a first implementation of the present invention, there is provided a gait generation device for 
generating a desired gait for a legged mobile robot that moves by operating a plurality of legs extending from a body, 
comprising: allowable range setting means for setting an allowable range of a I imitation -target quantity, the limitation- 
's target quantity being at least any of a horizontal component of a translation floor reaction force or a floor- surf ace- 
parallel component of a translation floor reaction force applied to the robot or a horizontal component of a total center- 
of-gravity acceleration or a floor-surface-parallel component of a total center-of-gravity acceleration of the robot and 
a floor reaction forcemoment or a ZMP; provisional instantaneous value determining means for determining provisional 
instantaneous values of a desired movement and a desired floor reaction force of the desired gait; model calculating 
20 means that inputs at least the provisional instantaneous value of the desired movement to a dynamics model to de- 
termine a model floor reaction force instantaneous value as an output of the dynamics model, the dynamics model 
representing a relationship between a movement and a floor reaction force of the robot; and desired instantaneous 
value determining means for correcting the provisional instantaneous value of the desired movement to determine a 
desired instantaneous value of the desiredmovement based on at least the difference between the model floor reaction 
25 force instantaneous value and the provisional instantaneous value of the desired floor reaction force and the allowable 
range, wherein the desired instantaneous value determining means corrects the provisional instantaneous value of 
the desired movement in such a manner that the I imitation -target quantity which corresponds to the instantaneous 
value of the floor reaction force substantially in balance with, in the dynamics model, the resultant force of an inertial 
force and gravity applied to the robot caused by the desired instantaneous value of the desired movement falls within 
30 the allowable range. 

[0028] In the present invention (including the implementations other than the first implementation) , the horizontal 
component of the translation floor reaction force orthe floor-surf ace-parallel component of the translation floor reaction 
force (specifically, the component parallel to the floor surface) and the horizontal component of the total center-of- 
gravity acceleration or the floor-surface-parallel component of the total center-of-gravity acceleration of the robot are 
35 exactly or approximately proportional to the friction force. Thus, in the following description, these are sometimes 
collectively referred to as a friction force component, for convenience. 

[0029] According to the first implementation, the model calculating means only determines the model floor reaction 
force instantaneous value (instantaneous value of the floor reaction force which corresponds to the provisional instan- 
taneous value of the desired movement and is in balance with the resultant force of the inertial force and gravity on 

40 the dynamics model) from at least the input provisional instantaneous value of the desired movement (instantaneous 
value of the position/posture or the like of an end portion of a leg). Therefore, even if the dynamics model is a relatively 
precise one, the model floor reaction force instantaneous value can be calculated with a relatively small amount of 
calculation. In this case, the difference between the model floor reaction force instantaneous value and the provisional 
instantaneous value of the desired floor reaction force represents an error of a provisional instantaneous value for the 

^5 desired movement and the desired floor reaction force input to the dynamics model with respect to dynamical equilibrium 
conditions thereof (conditions concerning a balance between the resultant force of the inertial force and gravity caused 
by the movement and the floor reaction force) (this error is referred to as a provisional instantaneous value error, 
hereinafter). However, in sixteenth to twenty-second implementations which are based essentially on the first imple- 
mentation, the desired movement input to the dynamics model is one for which the provisional instantaneous value 

50 for the desired movement has been corrected, and therefore, the error is not an error in a strict sense. However, it is 
referred to as an error for the sake of convenience. In the first implementation, based on at least the provisional in- 
stantaneous value error and the allowable range of the limitation-target quantity, the provisional instantaneous value 
of the desired movement is corrected, and the desired instantaneous value of the desired movement is determined. 
The provisional instantaneous value of the desired movement is corrected in such a manner that the limitation-target 

55 quantity which corresponds to the instantaneous value of the floor reaction force substantially in balance with, on the 
dynamics model, the resultant force of the inertial force and gravity applied to the robot caused by the desired instan- 
taneous value of the desired movement falls within the allowable range. Thus, the desired instantaneous value of the 
desired gait that allows the limitation-target quantity (the friction force component, the ZMP orthe floor reaction force's 
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moment) to fail within the allowable range can be calculated with a small amount of calculation without a calculation 
in a searching manner or the like. In addition, since the desired instantaneous value of the desired gait which allows 
the I imitation -target quantity, such as the friction force component, to fall within the allowable range can be determined, 
a variety of desired gaits not only for normal wal king but also for running, walking on a floor of a low friction coefficient 
5 or the like can be adequately generated. 

[0030] In principle, the dynamics model used is preferably a one with a high approximation precision. This allows a 
desired gait that precisely satisfies the dynamical equilibrium condiLion to be generated. 

[0031] In principle, in the first implementation, the provisional instantaneous value is preferably corrected in such a 
manner that the provisional instantaneous value error is stabilized as highly as possible or brought close to 0 as pre- 
10 cisely as possible (the variation of the error is reduced to a minimum) while keeping the limitation-target quantity falling 
within the allowable range. 

[0032] In the first implementation, preferably, model floor reaction force instantaneous values determined by the 
model calculating means include at least a model value of the floor reaction force moment or the ZMP, provisional 
instantaneous values of the desired floor reaction force determined by the provisional instantaneous value determining 

15 means include at least a provisional desired instantaneous value of the floor reaction force moment or the ZMP, and 
the difference used by the desired instantaneous value determining means is the difference between the model value 
of the floor reaction force moment or the ZMP and the provisional desired instantaneous value of the floor reaction 
force moment or the ZMP (second implementation). This increases the reliability of the provisional instantaneous value 
error as an indicator of the error with respect to the dynamical equilibrium condition. This allows the provisional desired 

20 instantaneous value to be adequately corrected and a desired gait that precisely satisfies the dynamical equilibrium 
condition to be generated. 

[0033] In addition, in the first and second implementations, preferably, the desired instantaneous value determining 
means determines, as the desired instantaneous value of the desired floor reaction force, the instantaneous value of 
the floor reaction force substantially in balance with, in the dynamics model, the resultant force of an inertial force and 

25 gravity applied to the robot caused by the desired instantaneous value of the desired movement (third implementation). 
This allows a desired instantaneous value of the desired floor reaction force that precisely satisfies the dynamical 
equilibrium condition to be determined for the desired instantaneous value of the desired movement. 
[0034] In the first to third implementations, preferably, the desired instantaneous value determining means comprises: 
a perturbation model that represents a relationship between a perturbation movement and a perturbation floor reaction 

30 force of the robot; means for determining a perturbation model manipulating quantity for manipulating the perturbation 
floor reaction force of the perturbation model based on at least the difference and the allowable range; means for 
determining a correction quantity for the desired movement by inputting the determined perturbation model manipu- 
lating quantity to the perturbation model; and means for determining a desired instantaneous value of the desired 
movement by correcting the provisional instantaneous value of the desired movement by the correction quantity (fourth 

35 implementation). 

[0035] Since the linearity of the relationship between the perturbation movement of the robot and the perturbation 
floor reaction force is high, using the perturbation model allows an adequate correction quantity for the desired move- 
ment to be readily calculated and the provisional instantaneous value to be readily corrected by the correction quantity. 
In addition, since a quantity for manipulating the perturbation floor reaction force of the perturbation model is determined 

40 as the perturbation model manipulating quantity, an adequate perturbation manipulating quantity for limiting the limi- 
tation-target quantity intimately associated with the floor reaction force within the allowable range can be determined. 
[0036] Furthermore, in the fourth implementation using the perturbation model, preferably, the gait generation device 
further comprises means for determining a required value of the perturbation model manipulating quantity in accordance 
with at least a state quantity of the perturbation model, wherein the means for determining a perturbation model ma- 

45 nipulating quantity determines the perturbation model manipulating quantity to be input to the perturbation model based 
on the difference (provisional instantaneous value error), the allowable range and the required value (fifth implemen- 
tation). 

[0037] This allows the perturbation model manipulating quantity to be determined taking into consideration not only 
the provisional instantaneous value error and the allowable range but also a required value of a state quantity of the 
perturbation model (such as position or rotation angle of a material particle or rotatable body, which is an element of 
the perturbation model, or variation rate thereof). Thus, the stability of the behavior of the perturbation model is en- 
hanced , and therefore, an inadequate correction quantity forthe desired movement is prevented from being determined. 
[0038] In this case, in particular, preferably, the gait generation device further comprises means for successively 
determining the required value of the perturbation model manipulating quantity according to a feedback control law in 
accordance with a deviation of the state quantity of the perturbation model from a desired value of the state quantity 
(sixth implementation). 

[0039] This allows the perturbation model manipulating quantity to be determined so as to generally keep the state 
quantity of the perturbation model in the vicinity of a certain desired value. Thus, the stability of the behavior of the 
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perturbation model can be enhanced with a higher reliability. 

[0040] In the fourth to sixth implementations, preferably, the perturbation model is a model that involves a plurality 
of perturbation movements having different perturbation ratios between the horizontal component of the translation 
floor reaction force and the floor reaction force moment to the perturbation movement, the perturbation model manip- 
5 ulating quantity comprises a plurality of kinds of manipulating quantity associated with the respective perturbation 
movements, and the correction quantity for the desired movement comprises a plurality of kinds of correction quantity 
associated with the respective perturbation movements (seventh implementation). 

[0041 J In this case, a plurality of kinds of perturbationmovement of the robot can be manipulated to correct the pro- 
visional instantaneous value of the desired movement. Thus, even when manipulating only one perturbation model 

10 cannot make the limitation-target quantity fall within the allowable range, a correction quantity forthe desiredmovement 
that can produce a floor reaction force that allows the limitation-target quantity to fall within the allowable range can 
be determined by manipulating another perturbation model or manipulating a plurality of perturbation models in a 
synthesized manner. Thus, the provisional instantaneous value of the desired movement that allows the limitation- 
target quantity to fall within the allowable range can be determined regardless of the width of the allowable range of 

15 the limitation-target quantity or the like. 

[0042] Furthermore, in the seventh implementation, preferably, for example, the plurality of perturbation movements 
comprise a translation movement of the body of the robot and a posture varying movement in which the posture of a 
predetermined part of the robot is varied while keeping the center of gravity of the robot substantially unchanged (eighth 
implementation) . In this case, since the translation floor reaction force can be manipulated by the body translation 

20 movement and the floor reaction force's moment can be manipulated by the posture varying movement, a desired 
instantaneous value of the desired movement that can produce a desired floor reaction force (a floor reaction force 
that allows the limitation-target quantity to fail within the allowable range) can be determined by synthesizing the move- 
ments. 

[0043] Alternatively, in theseventhimplementation, preferably the plurality of perturbation movements comprise a 
25 translation horizontal movement of the body of the robot and a posture varying movement of the body of the robot 
(ninth implementation). Since the body of the robot generally has a larger mass than other parts including a leg, the 
variation of the floor reaction force is more sensitive to the perturbation movements of the body. Therefore, the correction 
quantities of the provisional instantaneous values of the desired movement of the robot for the perturbation movements 
can be reduced, and the stability of the posture of the robot moving with the desired gait can be improved. 
30 [0044] In addition, in the seventh to ninth implementations, the limitation-target quantity is preferably composed of 
a friction force component applied to the robot and a floor reaction force moment or ZMP (tenth implementation). 
[0045] In the seventh to ninth implementations, since a plurality of perturbation models are used, even when both 
of the friction force component and the floor reaction force's moment or ZMP are limitation-target quantities, the cor- 
rection quantity of the provisional instantaneous value of the desired movement that allows the limitation -target quan- 
35 titles to fall within the allowable ranges can be determined with reliability. As a result, the desired gait for a wide variety 
of conditions, such as running, walking on a floor of a low friction coefficient or the like, can be adequately generated. 
[0046] More specifically, in the fourth implementation using the perturbation model, for example, the perturbation 
model manipulating quantity comprises a first manipulating quantity component that is determined according to at least 
the difference (provisional instantaneous value error) and a second manipulating quantity component that is determined 
40 based on at least the allowable range, and the means for determining a perturbation model manipulating quantity 
comprises: means for determining an estimated value of the limitation-target quantity corresponding to the desired 
instantaneous value of the desired movement that is determined if only the first manipulating quantity component is 
input to the perturbation model; means for determining a limited limitation-target quantity by comparing the determined 
estimated value of the I imitation -target quantity with the allowable range and limiting the limitation-target quantity within 
the allowable range based on the result of comparison; and means for determining the second manipulating quantity 
component based on at least the limited limitation-target quantity (eleventh implementation). 

[0047] That is. in the eleventh implementation, when determining the perturbation model manipulating quantity, first, 
there is determined an estimated value of the limitation-target quantity corresponding to the desired instantaneous 
value of the desired movement that is determined if only the first manipulating quantity component which takes into 
consideration only the provisional instantaneous value error without considering the allowable range (assuming that 
there is no allowable range of the limitation-target quantity) is input to the perturbation model (such a first manipulating 
quantity component is determined, in principle, so as to stabilize the provisional instantaneous value error or bring the 
same close to 0). Then, after the limited limitation-target quantity, which is obtained by limiting the estimated value of 
the limitation-target quantity within the allowable range, is determined, the second manipulating quantity component 
is determined based on at least the limited limitation-target quantity. Thus, the second manipulating quantity component 
required for making the limitation-target quantity fall within the allowable range is adequately determined. Since the 
second manipulating quantity component thus determined and the first manipulating quantity component are input to 
the perturbation model, a correction quantity of the provisional instantaneous value of the desired movement that allows 



45 



50 



55 



6 



BNSDOCID: <EP 1473122A1. I > 



EP 1 473 122 A1 



the limitation-target quantity to fall within the allowable range while stabilizing the provisional instantaneous value error 
or bringing the same to 0, that is, an adequate correction quantity, can be output from the perturbation model. 
[0048] In the case of determining the limited limitation-target quantity in principle, a value which is as close to the 
estimated value of the limitation-target quantity as possible and falls within the allowable range is preferably determined 

5 as the limited limitation-target quantity. 

[0049] In particular in Lhe fiflh and sixth implementations using the required value for the perturbation model, the 
perturbation model manipulating quantity comprises a first manipulating quantity component thai is determined ac- 
cording to at least the difference and a second manipulating quantity component that is determined based on at least 
the required value and the allowable range, and the means for determining a perturbation model manipulating quantity 

10 comprises: means for determining an estimated value of the limitation-target quantity corresponding to the desired 
instantaneous value of the desired movement that is determined if the second manipulating quantity component which 
is made to agree with the required value and the first manipulating quantity component are input to the perturbation 
model; means for determining a limited limitation-target quantity by comparing the determined estimated value of the 
limitation-target quantity with the allowable range and limiting the limitation -target quantity within the allowable range 

75 based on the result of comparison; and means for determining the second manipulating quantity component based on 
at least the limited limit at ion -target quantity (twelfth implementation). 

[0050] That is, in the twelfth implementation, when determining the perturbation model manipulating quantity, first, 
there is determined an estimated value of the limitation-target quantity corresponding to the desired instantaneous 
value of the desired movement that is determined assuming that the first manipulating quantity component which takes 
20 into consideration only the provisional instantaneous value error (the first manipulating quantity component is deter- 
mined, in principle, so as to stabilize the provisional instantaneous value error or bring the same close to 0) and the 
second manipulating quantity component which is made to agree with the required value without considering the al- 
lowable range (assuming that there is no allowable range of the limitation-target quantity) are input to the perturbation 
model. Then, afterthe limited limitation-target quantity, which is obtained by limiting the estimated value of the limitation- 
's target quantity within the allowable range, is determined, the second manipulating quantity component is determined 
based on at least the limited limitation-target quantity. Thus, the second manipulating quantity component required for 
making the limitation-target quantity fall within the allowable range and stabilizing the perturbation model is adequately 
determined. Since the second manipulating quantity component thus determined and the first manipulating quantity 
component are input to the perturbation model, a correction quantity of the provisional instantaneous value of the 
30 desired movement that allows the limitation-target quantity to fail within the allowable range while stabilizing the pro- 
visional instantaneous value error and assuring the stability of the perturbation model, that is, an adequate correction 
quantity, can be output from the perturbation model. 

[0051] In the eleventh or twelfth implementation, preferably, when the limitation-target quantity comprises the friction 
force component, the means for determining a perturbation model manipulating quantity determines the estimated 
35 value of the limitation-target quantity using, as the model floor reaction force instantaneous value, the instantaneous 
value of the horizontal component of the translation floor reaction force or the instantaneous value of the floor-surface- 
parallel component of the translation floorreaction force determined bythe dynamics model (thirteenth implementation). 
In this case, an estimated value of the friction force component as the limitation-target quantity (limitation-target quantity 
which takes into consideration only the provisional instantaneous value error or the required value neglecting the al- 
lowable range) can be adequately determined, and thus, a reliable limited limitation-target quantity (the friction force 
component limited to the allowable range) can be determined. 

[0052] In the twelfth implementation or the thirteenth implementation based essentially thereon, preferably, the per- 
turbation model is a model that involves a translation movement of the body of the robot and a posture varying movement 
of the body of the robot, and when the limitation-target quantity comprises the friction force component applied to the 
robot and the floor reaction force moment or the ZMP, the means for determining a limited limitation-target quantity 
determines each limited limitation-target quantity in such a manner that the variation of a manipulation quantity com- 
ponent of the second manipulating quantity components which is associated with the body posture varying movement 
from the required value is reduced to a minimum, and the variation of the limited limitation-target quantity from the 
estimated value is reduced to a minimum (fourteenth implementation). 

[0053] As described above concerning the tenth implementation, when the limitation -target quantity comprises the 
friction force component and the floor reaction force's moment or the ZMP, it is preferable that a perturbation model 
involving a plurality of perturbation movements, such as a model involving a body translation movement and a body 
posture varying movement, is used. However, as the perturbation of the body posture varying movement is increased 
to allow the limitation-target quantity to fall within the allowable range, the body posture tends to varymore significantly. 
Therefore, it is preferable that, of the second manipulating quantity components, a manipulating quantity component 
associated with the body posture varying movement is as close to the required value as possible. Therefore, in the 
fourteenth implementation, each limited limitation-target quantity is determined in such a manner that the variation of 
a manipulation quantity component of the second manipulating quantity components which is associated with the body 
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posture varying movement from the required value is reduced to a minimum, and the variation of the limited limitation- 
target quantity from the estimated value is reduced to a minimum. Thus, the desired instantaneous value of the desired 
movement that can make the limitation-target quantity fail within the allowable range can be determined while reducing 
the variation of the body posture varying movement to a minimum and assuring the highest possible stability of the 
5 perturbation model 

[0054] In the eleventh Lo fourteenth implementations, the desired instantaneous value determining means determines 
the floor reaction force associated with the limited limiLation-target quantity as the desired instantaneous value of the 
desired floor reaction force (fifteenth implementation). This allows a desired instantaneous value of the desired floor 
reaction force that is in balance with the resultant force of the inertia! force and gravity produced on the dynamics model 
10 to be determined for the desired instantaneous value of the desired movement. 

[0055] In the first to tenth implementations, the desired instantaneous value determining means comprises: means 
for additionally inputting a correction quantity for correcting the provisional instantaneous value of the desired move- 
ment to the dynamics model; and means for determining the correction quantity in such a manner that the limitation- 
target quantity associated with the model floor reaction force instantaneous value is substantially kept at a value within 
15 the allowable range and the difference is stabilized (sixteenth implementation). 

[0056] In this case, besides the provisional instantaneous value of the desired movement, the correction quantity for 
correcting the provisional value is additionally input to the dynamics model. Therefore, the model floor reaction force 
instantaneous value, which is output from the dynamics model, satisfies the dynamical equilibrium condition for the 
corrected desired movement on the dynamics model . Thus, since the correction q uantity is determined in such a manner 
20 that the limitation-target quantity associated withthe modelfloor reaction force instantaneous value is substantially kept 
at a value within the allowable range and the difference is stabilized, the desired instantaneous value of the desired 
movement which can precisely satisfy the dynamical equilibrium condition and allow the limitation-target quantity to 
fall within the allowable range can be determined. In this case, the provisional instantaneous value of the desired 
movement which is corrected by the correction quantity, that is, the desired instantaneous value of the desired move- 
rs ment may be input to the dynamics model. 

[0057] In the fourth implementation using the perturbation model, as in the sixteenth implementation, when the de- 
sired instantaneous value determining means comprises means for additionally inputting a correction quantity for the 
desired movement to the dynamics model, the perturbation model manipulating quantity comprises a first manipulating 
quantity component that is determined according to at least the difference (provisional instantaneous value error) and 
30 a second manipulating quantity component that is determined based on at least the allowable range. In addition, the 
means for determining a perturbation model manipulating quantity comprises: means for determining an estimated 
value of the I imitation -target quantity corresponding to the model floor reaction force instantaneous value that is output 
from the dynamics model if only the first manipulating quantity component is input to the perturbation model; means 
for determining a limited limitation-target quantity by comparing the determined estimated value of the limitation-target 
35 quantity with the allowable range and limiting the limitation-target quantity within the allowable range based on the 
result of comparison; and means for determining the second manipulating quantity component based on at least the 
limited control-target quantity (seventeenth implementation). 

[0058] Thus, as in the eleventh implementation, the second manipulating quantity component required for making 
the limitation-target quantity fall within the allowable range is adequately determined. Since the second manipulating 

40 quantity component thus determined and the first manipulating quantity component are input to the perturbation model, 
a correction quantity of the provisional instantaneous value of the desired movement that allows the I imitation -target 
quantity, which corresponds to the model floor reaction force instantaneous value that is output from the dynamics 
model, to fall within the allowable range while stabilizing the provisional instantaneous value error, that is, an adequate 
correction quantity can be output from the perturbation model. 

45 [0059] In particular, in the fifth and sixth implementations using the required value for the perturbation model, as in 
the sixteenth implementation, when the desired instantaneous value determining means comprises means for addi- 
tionally inputting a correction quantity for the desired movement to the dynamics model, the perturbation model ma- 
nipulating quantity comprises a first manipulating quantity component that is determined according to at least the dif- 
ference and a second manipulating quantity component that is determined based on at least the required value and 

50 the allowable range. In addition, the means for determining a perturbation model manipulating quantity comprises: 
means for determining an estimated value of the limitation-target quantity corresponding to the model floor reaction 
force instantaneous value that is output from the dynamics model if the second manipulating quantity component which 
is made, to agree with the required value and the first manipulating quantity component are input to the perturbation 
model; means for determining a limited limitation-target quantity by comparing the determined estimated value of the 

55 limitation-target quantity with the allowable range and limiting the limitation-target quantity within the allowable range 
based on the result of comparison; and means for determining the second manipulating quantity component based on 
at least the limited control-target quantity, (eighteenth implementation). 

[0060] Thus, as in the twelfth implementation, the second manipulating quantity component required for making the 
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limitation-target quantity fall within the allowable range and stabilizing the perturbation model is adequately determined. 
Since the second manipulating quantity component thus determined and the first manipulating quantity component are 
input to the perturbation model, a correction quantity of the provisional instantaneous value of the desired movement 
that allows the I imitation -target quantity to fall within the allowable range while stabilizing the provisional instantaneous 
5 value error and assuring the stability of the perturbation model, that is, an adequate correction quantity, can be output 
from the perturbalion model. 

[0061] In the seventeenth or eighteenth implementation, preferably, when the second manipulating quantity compo- 
nents include the floor reaction force s moment or the ZMP and the differences (provisional instantaneous value errors) 
include at least the difference concerning the floor reaction force moment or ZMP, the means for determining a pertur- 

io bation model manipulating quantity comprises means for determining the first manipulating quantity component in such 
a manner that the floor reaction force moment or ZMP concerning the difference is substantially equal to the floor 
reaction force moment or ZMP of the second manipulating quantity components (nineteenth implementation). 
[0062] This allows a desired instantaneous value for the desired movement that suitably stabilizes the provisional 
instantaneous value error of the floor reaction force's moment or ZMP to be determined. 

15 [0063] In the seventeenth to nineteenth implementations, preferably, as in the thirteenth implementation, when the 
limitation-target quantity comprises the friction force component, the means for determining a perturbation model ma- 
nipulating quantity determines the estimated value of the limitation-target quantity using, as the model floor reaction 
force instantaneous value, the instantaneous value of the horizontal component of the translation floor reaction force 
or the instantaneous value of the floor-surface-parallel component of the translation floor reaction force determined by 

20 the dynamics model (twentieth implementation). In this case, as in the thirteenth implementation, an estimated value 
of the friction force component as the limitation -target quantity (limitation-target quantity which takes into consideration 
only the provisional instantaneous value error or the required value neglecting the allowable range) can be adequately 
determined, and thus, a reliable limited I imitation -target quantity (the friction force component limited to the allowable 
range) can be determined. 

25 [0064] In the eighteenth implementation or the nineteenth to twentieth implementations based essentially thereon, 
preferably, as in the fourteenth implementation, when the perturbation model is a model that involves a translation 
movement of the body of the robot and a posture varying movement of the body of the robot, and the limitation-target 
quantity comprises the friction force component and the floor reaction force moment or the ZMP, the means for deter- 
mining a limited limitation-target quantity determines each limited limitation-target quantity in such a manner that the 

30 variation of a manipulation quantity component of the second manipulating quantity components which is associated 
with the body posture varying movement from the required value is reduced to a minimum, and the variation of the 
limited limitation-target quantity from the estimated value is reduced to a minimum (twenty-first implementation). 
[0065] Thus, as in the fourteenth implementation, the desired instantaneous value of the desired movement that can 
make the limitation-target quantity fall within the allowable range can be determined while reducing the variation of the 

35 body posture varying movement to a minimum and assuring the highest possible stability of the perturbalion model. 
[0066] In the sixteenth to twenty-first implementations, the desired instantaneous value determining means deter- 
mines the model floor reaction force instantaneous value as the desired instantaneous value of the desired floor reaction 
force (twenty-second implementation) That is, as described above, in the sixteenth to twenty-first implementations, 
besides the provisional instantaneous value of the desired movement, the correction quantity for correcting the instan- 
ce taneous provisional value is additionally input to the dynamics model. Therefore/the model floor reaction force instan- 
taneous value, which is output from the dynamics model, satisfies the dynamical equilibrium condition for the corrected 
desired movement on the dynamics model. Therefore, since the model floor reaction force instantaneous value is 
determined as the desired instantaneous value of the desired floor reaction force, a desired instantaneous value of 
the desired floor reaction force that is in balance with the resultant force of the inertial force and gravity produced on 

45 the dynamics model can be determined for the desired instantaneous value of the desired movement. 

[0067] According to a twenty-third implementation of the present invention, there is provided a gait generation device 
for generating a desired gait for a legged mobile robot that moves by operating a plurality of legs extending from a 
body, characterized in that the gait generation device comprises: allowable range setting means for setting an allowable 
range of a limitation-target quantity, the limitation-target quantity being at least any of a friction force component applied 

50 to the robot and a floor reaction force's moment or a ZM P; provisional instantaneous value of the desired floor reaction 
force determining means for successively determining, of a desired movement and a desired floor reaction force of 
the desired gait, at least a provisional instantaneous value of the desired floor reaction force; first model calculating 
means that inputs at least the provisional instantaneous value of the desired floor reaction force to a first dynamics 
model to determine a provisional instantaneous value of the desired movement as an output of the first dynamics 

55 model, the first dynamics model representing a relationship between a movement and a floor reaction force of the 
robot; and second model calculating means that inputs at least the provisional instantaneous value of the desired 
movement to a second dynamics model to determine a model floor reaction force instantaneous value as an output of 
the second dynamics model, the second dynamics model representing a relationship between a movement and a floor 
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reaction force of the robot; and first model input correcting means that determines a correction quantity of the desired 
floor reaction force based on at least the difference between the model floor reaction force instantaneous value and 
the provisional instantaneous value of the desired floor reaction force and the allowable range in such a manner that 
the limitation-target quantity corresponding to the model floor reaction force instantaneous value that is output from 
5 the second dynamics model falls within the allowable range and additionally inputs the determined correction quantity 
to the first dynamics model, wherein the desired instantaneous value of the desired movement is determined based 
on at least the input to the second dynamics model. 

[0068] In the twenty-third implementation, two dynamics models, that is, the first dynamics model which receives the 
provisional instantaneous value of the desired floor reaction force and outputs the provisional instantaneous value for 

10 the desired movement and the second dynamics model which receives the output of the first dynamics model (provi- 
sional instantaneous value for the desired movement) and outputs the model floor reaction force instantaneous value 
are used. As described above concerning the first implementation, the difference between the model floor reaction 
force instantaneous value output from the second dynamics model and the provisional instantaneous value of the 
desired floor reaction force input to the first dynamics model is determined as a provisional instantaneous value error 

15 that represents a deviation of a provisional instantaneous value for the desired movement and the desired floor reaction 
force input to the second model from the dynamical equilibrium conditions However, in twenty-seventh to thirty-ninth 
implementations which are based essentially on the twenty-third implementation, the desired movement input to the 
second model is one for which the provisional instantaneous value for the desired movement has been corrected, and 
therefore, the error is not an error in a strict sense. However, it is referred to as an error for the sake of convenience. 

20 Since a correction quantity of the desired floor reaction force is determined based on at least the provisional instanta- 
neous value error and the allowable range of the limitation-target quantity in such a manner that the limitation-target 
quantity (the friction force component or the ZMP or the floor reaction forced moment) corresponding to the model 
floor reaction force instantaneous value that is output from the second dynamics model fails within the allowable range, 
and the determined correction quantity is additionally input to the first dynamics model, an instantaneous value for the 

25 desired movement that stabilizes the provisional instantaneous value error and allows the limitation-target quantity to 
fall within the allowable range can be output from the first dynamics model. Thus, by determining the desired instan- 
taneous value for the desired movement based on the input to the second dynamics model, the desired instantaneous 
value of the desired gait that allows the limitation-target quantity to fall within the allowable range can be obtained. In 
this case, since the output of the first dynamics model is manipulated by the correction quantity of the desired floor 

30 reaction force, the first dynamics model is not required to have a quite high approximation precision. Thus, the amount 
of calculation of the first model calculation means that performs calculation for the first dynamics model can be reduced. 
As with the model calculating means in the first implementation, the second model calculating means for performing 
calculation for the second dynamics model only determines the model floor reaction force instantaneous value (instan- 
taneous value of the floor reaction force which corresponds to the provisional instantaneous value of the desired move- 

35 ment and is in balance with the resultant force of the inertial force and gravity on the dynamics model) from at least 
the input provisional instantaneous value of the desired movement (instantaneous value of the position/posture or the 
like of an end portion of a leg). Therefore, even if the second dynamics model is a relatively precise one, the model 
floor reaction force instantaneous value can be calculated with a relatively small amount of calculation. As a result, 
according to the twenty-third implementation, as in the first implementation, the desired instantaneous value of the 

40 desired gait that allows the limitation-target quantity to fall within the allowable range can be determined with a relatively 
small amount of calculation. In addition, since the desired instantaneous value of the desired gait which allows the 
limitation-target quantity, such as the friction force component, to fall within the allowable range can be determined, a 
variety of desired gaits not only for normal walking but also for running, walking on a floor of a low friction coefficient 
or the like can be adequately generated. 

45 [0069] While, in principle, the first dynamics model may be one with a relatively low approximation precision, the 
second dynamics model is preferably one with a relatively high approximation precision. This allows a desired gait that 
precisely satisfies the dynamical equilibrium condition to be generated. 

[0070] In the twenty-third implementation, preferably, model floor reaction force instantaneous values determined 
by the second model calculating means include at least a model value of the floor reaction force moment or the ZMP, 

50 provisional instantaneous values of the desired floor reaction force determined by the provisional instantaneous value 
determining means include at least a provisional desired instantaneous value of the floor reaction force moment or the 
ZMP, and the difference used by the first model input correcting means is the difference between the model value of 
the floor reaction force's moment or the ZM P and the provisional desired instantaneous value of the floor reaction force 
moment or the ZMP (twenty-fourth implementation). As in the second implementation, this increases the reliability of 

55 the provisional instantaneous value error as an indicator of the error with respect to the dynamical equilibrium condition, 
and therefore, a desired gait that precisely satisfies the dynamical equilibrium condition can be generated. 
[0071] In the twenty-third and twenty-fourth implementations, the desired instantaneous value determining means 
determines the model floor reaction force instantaneous value output from the second dynamics model as the desired 
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instantaneous value of the desired floor reaction force (twenty-fifth implementation). That is ; since an adequate desired 
instantaneous value for the desired movement that allows the limitation-target quantity to fall within the allowable range 
is input to the second dynamics model, as in the twenty-second implementation, the model floor reaction force instan- 
taneous value, which is output from the second dynamics model, satisfies the dynamical equilibrium condition for the 

5 desired instantaneous value for the desired movement on the second dynamics model. Therefore, since the model 
floor reaction force instantaneous value is determined as the desired instantaneous value of the desired floor reaction 
force, a desired instantaneous value of the desired floor reaction force that is in balance with the resultant force of the 
inertial force and gravity produced on the second dynamics model can be determined for the desired instantaneous 
value of the desired movement. 

w [0072] In the twenty-third to twenty-fifth implementations, preferably, the gait generation device further comprises 
means for determining a required value of the correction quantity of the desired floor reaction force, wherein the cor- 
rection quantity of the desired floor reaction force determined by the first model input correcting means comprises a 
first correction quantity component that is determined according to at least the difference and a second correction 
quantity component that is determined based on at least the required value and the allowable range; the first model 

15 input correcting means comprises: means for determining an estimated value of the limitation-target quantity corre- 
sponding to the model floor reaction force instantaneous value that is output from the second dynamics model if the 
second correction quantity component which is made to agree with the required value and the first correction quantity 
component are additionally input to the first dynamics model; means for determining a limited limitation-target quantity 
by comparing the determined estimated value of the limitation-target quantity with the allowable range and limiting the 

20 limitation-target quantity within the allowable range based on the result of comparison; and means for determining the 
second correction quantity component based on at least the limited limitation-target quantity (twenty-sixth implemen- 
tation). 

[0073] That is, in the twenty-sixth implementation, when determining the correction quantity of the desired floor re- 
action force input to the first dynamics model, first, there is determined an estimated value of the limitation-target 
25 quantity corresponding to the desired instantaneous value for the desired movement that is determined assuming that 
the first manipulating quantity component which takes into consideration only the provisional instantaneous value error 
(the first manipulating quantity component is determined, in principle, so as to stabilize the provisional instantaneous 
value error) and the second manipulating quantity component which is made to agree with the required value without 
considering the allowable range (assuming that there is no allowable range of the limitation-target quantity) are addi- 
30 tionally input to the first dynamics model. Then, after the limited I imitation -target quantity, which is obtained by limiting 
the estimated value of the limitation -target quantity within the allowable range, is determined, the second correction 
quantity component is determined based on at least the limited limitation-target quantity. Thus, the second correction 
quantity component required for making the I imitation -target quantity fall within the allowable range is adequately de- 
termined. Since the second correction quantity component thus determined and the first correction quantity component 
are additionally input to the first dynamics model, an instantaneous value for the desired movement that stabilizes the 
provisional instantaneous value error and allows the limitation-target quantity to fall within the allowable range can be 
input from the first dynamics model to the second dynamics model. 

[0074] In the twenty-third to twenty-fifth implementations, the gait generation device further comprises second model 
input correcting means that determines a correction quantity for the desired movement based on at least the difference 
40 (provisional instantaneous value error) and the allowable range, and additionally inputs the determined correction 
quantity to the second dynamics model (twenty-seventh implementation). In this case, a desired gait with a higher 
dynamical precision can be generated with an enhanced stability of the first dynamics model. 

[0075] In the twenty-seventh implementation, preferably, the gait generation device further comprises: a perturbation 
model that represents a relationship between a perturbation movement and a perturbation floor reaction force of the 
45 robot; means for determining a floor reaction force manipulating quantity based on at least the difference and the 
allowable range: and distributor means for separating the determined floor reaction force manipulating quantity into a 
correction quantity of the desired floor reaction force that is to be input to the first dynamics model and a perturbation 
model manipulating quantity that is to be input to the perturbation model, and the second model input correcting means 
determines the correction quantity for the desiredmovement by inputting the perturbation model manipulating quantity 
to the perturbation model (twenty-eighth implementation). 

[0076] In this case, since the floor reaction force manipulating quantity is separated into the correction quantity of 
the desired floor reaction force that is to be input to the first dynamics model and the perturbation model manipulating 
quantity that is to be input to the perturbation model, the first dynamics model and the perturbation model can receive 
inputs suitable for their respective characteristics. Thus, a desired instantaneous value for the desired movement that 
stabilizes the provisional instantaneous value error and allows the limitation-target quantity to fall within the allowable 
range can be determined while preventing the first dynamics model and the perturbation model from being unstable. 
In addition, using the perturbation model facilitates calculation of the correction quantity for the desired movement that 
is additionally input to the second dynamics model. 
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[0077] When the floor reaction force manipulating quantity is separated into the correction quantity of the desired 
floor reaction force to be input to the first dynamics model and the perturbation model manipulating quantity to be input 
to the perturbation model, in principle, it is preferable that a general variation of the floor reaction force manipulating 
quantity (variation approximate to a direct current or the like) is distributed to the first dynamics model, and a local 

5 variation (minor variation or the like) is distributed to the perturbation model. 

[0078] Thus, in the twenty-eighth implementation using Lhe perturbation model, preferably, the gait generation device 
further comprises means for determining a required value of the floor reaction force manipulating quantity in accordance 
with at least a state quantity of the perturbation model, wherein the means for determining a floor reaction force ma- 
nipulating quantity determines the floor reaction force manipulating quantity to be supplied to the distributor means 

10 based on the difference (provisional instantaneous value error), the allowable range and the required value (twenty- 
ninth implementation). 

[0079] In this case, as in the fifth implementation, the floor reaction force manipulating quantity to be input to the 
distributor means is determined taking into consideration not only the provisional instantaneous value error and the 
allowable range but also a required value of a state quantity of the perturbation model (such as position or rotation 

15 angle of a material particle or rotatable body, which is an element of the perturbation model, or variation rate thereof). 
Therefore, the stability of the behavior of the perturbation model is enhanced, and thus, an inadequate correction 
quantity for the desiredmovement can be prevented from being determined by the perturbation model. 
[0080] Furthermore, in the twenty-ninth implementation, preferably, the gait generation device further comprises 
means for successively determining the required value of the floor reaction force manipulating quantity according to a 

20 feedback control law in accordance with a deviation of the state quantity of the perturbation model from a desired value 
of the state quantity (thirtieth implementation). In this case, as in the sixth implementation, the stability of the behavior 
of the perturbation model can be enhanced with a higher reliability. 

[0081] In the twenty-eighth to thirtieth implementations, preferably, the perturbation model is a model that involves 
a plurality of perturbation movements having different perturbation ratios between the horizontal component of the 

25 translation floor reaction force and the floor reaction force moment to the perturbation movement, the floor reaction 
force manipulating quantity comprises a plurality of kinds of manipulating quantity associated with the respective per- 
turbation movements, and the correction quantity for the desired movement determined by the second model input 
correcting means comprises a plurality of kinds of correction quantity associated with the respective perturbation move- 
ments (thirty-first implementation). 

30 [0082] In this case, as in the seventh implementation, since a plurality of kinds of perturbation movements of the 
robot can be manipulated to correct the provisional instantaneous value for the desired movement, the provisional 
instantaneous value for the desired movement that allows the limitation-target quantity to fall within the allowable range 
can be determined regardless of the width of the allowable range of the limitation-target quantity or the like. 
[0083] Furthermore, in the thirty-first implementation, preferably, the plurality of perturbation movements comprise 

35 a translation movement of the body of the robot and a posture varying movement in which the posture of a predetermined 
part of the robot is varied while keeping the center of gravity of the robot substantially unchanged (thirty-second im- 
plementation). In this case, as in the eighth implementation, a desired instantaneous value for the desired movement 
that allows a preferred floor reaction force (a floor reaction force for which the limitation-target quantity falls within the 
allowable range) to be produced by combining the body translation movement and the posture varying movement can 

40 bo determined. 

[0084] Alternatively, in the thirty-first implementation, preferably, the plurality of perturbation movements comprise a 
translation horizontal movement of the body of the robot and a posture varying movement of the body of the robot 
(thirty-third implementation). 

[0085] In this case, as in the ninth implementation, the correction quantities of the provisional- instantaneous values 
45 for the desired movement can be reduced, and the stability of the posture of the robot moving with the desired gait can 
be improved. 

[0086] In addition, the thirty-first to thirty-third implementations are suitable for a case where the limitation-target 
quantity is composed of a friction force component applied to the robot and a floor reaction force moment or ZMP 
(thirty-fourth implementation). 

50 [0087] In this case, as in the tenth implementation, the desired gait for a wide variety of conditions, such as running, 
walking on a floor of a low friction coefficient or the like, can be adequately generated. 

[0088] More specifically, in the twenty-eighth implementation using the perturbation model, for example, the floor 
reaction force manipulating quantity comprises a first manipulating quantity component that is determined according 
to at least the difference and a second manipulating quantity component that is determined based on at least the 
55 allowable range, and the means for determining a floor reaction force manipulating quantity comprises: means for 
determining an estimated value of the limitation-target quantity corresponding to the model floor reaction force instan- 
taneous value that is output from the second dynamics model if only the first manipulating quantity component is input 
to the distributor means; means for determining a limited limitation-target quantity by comparing the determined esti- 
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mated value of the limitation -target quantity with the allowable range and limiting the limitation-target quantity within 
the allowable range based on the result of comparison; and means for determining the second manipulating quantity 
component based on at least the limited control-target quantity (thirty -fifth implementation). 

[0089] That is. in the thirty-fifth implementation, when determining the floor reaction force manipulating quantity, first, 

5 there is determined an estimated value of the limitation-target quantity corresponding to the model floor reaction force 
instantaneous value that is output from the second dynamics model assuming that only the first manipulating quantity 
component which takes into consideration only the provisional instantaneous value error without considering the al- 
lowable range (assuming that there is no allowable range of the limitation-target quantity) is input to the distributor 
means (such a first manipulating quantity component is determined, in principle, so as to stabilize the provisional 

fo instantaneous value error). Then, after the limited limitation-target quantity, which is obtained by limiting the estimated 
value of the limitation-target quantity within the allowable range, is determined, the second manipulating quantity com- 
ponent is determined based on at least the limited limitation-target quantity. Thus, the second manipulating quantity 
component required for making the limitation-target quantity fall within the allowable range is adequately determined. 
Since the second manipulating quantity component thus determined and the floor reaction force manipulating quantity 

15 including the first manipulating quantity component are input to the distributor means and separated into the correction 
quantity of the desired floor reaction force to be input to the first dynamics model and the perturbation model manipu- 
lating quantity to be input to the perturbation model, a desired instantaneous value for the desired movement that 
allows the limitation-target quantity to fall within the allowable range while enhancing stabiiityof the first dynamics model 
and the perturbation model and stabilizing the provisional instantaneous value error can be input to the second dy- 

20 namics model. 

[0090] In the case of determining the limited limitation-target quantity, in principle, a value which is as close to the 
estimated value of the limitation-target quantity as possible and falls within the allowable range is preferably determined 
as the limited limitation -target quantity. 

[0091] In particular, in the twenty-ninth and thirtieth implementations using the required value for the perturbation 
25 model, the floor reaction force manipulating quantity comprises a first manipulating quantity component that is deter- 
mined according to at least the difference and a second manipulating quantity component that is determined based 
on at least the required value andthe allowable range, and the means for determining a floor reaction force manipulating 
quantity comprises: means for determining an estimated value of the limitation-target quantity corresponding to the 
mode! floor reaction force instantaneous value that is output from the second dynamics model if the second manipu- 
30 lating quantity component which is made to agree with the required value and the first manipulating quantity component 
are input to the distributor means; means for determining a limited limitation-target quantity by comparing the deter- 
mined estimated value of the limitation-target quantity with the allowable range and limiting the limitation-target quantity 
within the allowable range based on the result of comparison; and means for determining the second manipulating 
quantity component based on at least the limited control -target quantity (thirty-sixth implementation). 
35 [0092] That is, in the thirty-sixth implementation, when determining the floor reaction force manipulating quantity, 
first, there is determined an estimated value of the limitation-target quantity corresponding to the model floor reaction 
force instantaneous value that is output from the second dynamics model assuming that the first manipulating quantity 
component which takes into consideration only the provisional instantaneous value error (the first manipulating quantity 
component is determined, in principle, so as to stabilize the provisional instantaneous value error) and the second 
40 manipulating quantity component which is made to agree with the required value without considering the allowable 
range (assuming that there is no allowable range of the limitation-target quantity) are input to the distributor means. 
Then, after the limited limitation-target quantity, which is obtained by limiting the estimated value of the limitation-target 
quantity within the allowable range, is determined, the second manipulating quantity component is determined based 
on at least the limited limitation-target quantity. Thus, the second manipulating quantity component required for making 
the limitation-target quantity fall within the allowable range and stabilizing the perturbation model with reliability is 
adequately determined. Since the second manipulating quantity component thus determined and the floor reaction 
force manipulating quantity including the first manipulating quantity component are input to the distributor means and 
separated into the correction quantity of the desired floor reaction force to be input to the first dynamics model and the 
perturbation model manipulating quantity to be input to the perturbation model, a desired instantaneous value for the 
desired movement that allows the limitation-target quantity to fall within the allowable range while enhancing stability 
of the first dynamics model and the perturbation model and stabilizing the provisional instantaneous value error can 
be input to the second dynamics model. 

[0093] In the thirty-fifth or thirty-sixth implementation, preferably when the limitation-target quantities include the 
floor reaction force moment or the ZMP and the differences (provisional instantaneous value errors) include at least 
the difference concerning the floor reaction force moment or ZMP, and the means for determining a perturbation model 
manipulating quantity comprises means for determining the first manipulating quantity component in such a manner 
that the floor reaction, force moment or ZMP concerning the differences (provisional instantaneous value errors) is 
substantially equal to the floor reaction force moment or ZMP of the limited limitation -target quantities (thirty-seventh 
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implementation). 

[0094] In this case, as in the nineteenth implementation, a desired instantaneous value for the desired movement 
that suitably stabilizes the provisional instantaneous value error of the floor reaction force's moment or ZMP can be 
determined. 

5 [0095] Furthermore, in the thirty-fifth to thirty-seventh implementations, preferably, when the limitation-target quantity 
comprises the friction force component, the means for determining a floor reaction force manipulating means deter- 
mines the estimated value of the limitation-target quantilyusing, as the model floor reaction force instantaneous value, 
the instantaneous value of the horizontal component of the translation floor reaction force or the instantaneous value 
of the floor-surface-parallel component of the translation floor reaction force determined by the dynamics model (thirty- 

10 eighth implementation). In this case, as in the twentieth implementation, an estimated value of the friction force com- 
ponent as the limitation-target quantity (limitation-target quantity which takes into consideration only the provisional 
instantaneous value error or the required value neglecting the allowable range) can be adequately determined, and 
thus, a reliable limited limitation-target quantity (the friction force component limited to the allowable range) can be 
determined. 

15 [0096] In the thirty-sixth implementation or the thirty-seventh or thirty-eighth implementation based essentially ther- 
eon, preferably, when the perturbation model is a model that involves a translation movement of the body of the robot 
and a posture varying movement of the body of the robot, and the limitation-target quantity comprises the friction force 
component and thef loor reaction force moment or the ZMP, the means for determining a limited limitation-target quantity 
determines each limited limitation-target quantity in such a manner that the variation of a manipulation quantity com- 

20 ponent of the second manipulating quantity components which is associated with the body posture varying movement 
from the required value is reduced to a minimum, and the variation of the limited limitation-target quantity from the 
estimated value is reduced to a minimum (thirty-ninth implementation). In this case, as in the fourteenth or twenty-first 
implementation, the desired instantaneous value of the desired movement that can make the limitation-target quantity 
fall within the allowable range can be determined while reducing the variation of the body posture varying movement 

25 to a minimum and assuring the highest possible stability of the perturbation model. 

[0097] According to a fortieth implementation of the present invention, there is provided a gait generation device for 
generating a desired gait for a legged mobile robot that moves by operating a plurality of legs extending from a body, 
characterized in that the gait generation device comprises: allowable range setting means for setting an allowable 
range of a limitation-target quantity, the limitation-target quantity being at least any of a friction force component applied 

30 to the robot and a floor reaction force moment or a ZM P; desired floor reaction force's provisional instantaneous value 
determining means for successively determining, of a desired movement and a desired floor reaction force of the 
desired gait, at least a provisional instantaneous value of the desired floor reaction force; first model calculating means 
that inputs at least the provisional instantaneous value of the desired floor reaction force to a first dynamics model to 
determine a first provisional instantaneous value of the desired movement as an output of the first dynamics model, 

35 the first dynamics model representing a relationship between a movement and a floor reaction force of the robot; second 
model calculating means that inputs at least the provisional instantaneous value of the desired floor reaction force to 
a second dynamics model, which represents a relationship between a movement and a floor reaction force of the robot, 
to determine a second provisional instantaneous value of the desired movement as an output of the second dynamics 
model in such a manner that the limitation-target quantity corresponding to the floor reaction force instantaneous value 

40 that is, in the second dynamics model, substantially in balance with the resultant force of the inertial force and center- 
of-gravity applied to the robot caused by the second provisional instantaneous value of the desired movement falls 
within the allowable range; manipulating quantity calculating means for determining the floor reaction force manipulating 
quantity based on at least the difference between the first provisional instantaneous value and the second provisional 
instantaneous value of the desired movement in such a manner that the difference is close to 0; and model input 

45 correcting means for additionally inputting the floor reaction force manipulating quantity to at least any one of the first 
dynamics model and the second dynamics model, wherein the second provisional instantaneous value of the desired 
movement is determined as the desired instantaneous value of the desired movement. 

[0098] According to the fortieth implementation, the first dynamics model and the second dynamics model which 
receive the provisional instantaneous value of the desired floor reaction force and output the provisional instantaneous 

50 values for the desired movement (the first provisional instantaneous value and the second provisional instantaneous 
value, respectively) are used. In this case, the calculation for the second dynamics model takes into consideration the 
allowable range of the limitation-target quantity, and the second provisional instantaneous value for the desired move- 
ment is determined in such a manner that the limitation-target quantity which corresponds to the instantaneous value 
of the floor reaction force substantially in balance with, on the second dynamics model, the resultant force of the inertial 

55 force and gravity applied to the robot caused by the second provisional instantaneous value of the desired movement 
falls within the allowable range. And, the floor reaction force manipulating quantity is determined based at least on the 
difference between the first provisional instantaneous value and the second provisional instantaneous value for the 
desired movement in such a manner that the difference is close to 0, and the determined floor reaction force manipu- 
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lating quantity is additionally input to at least any one of the first dynamics model and the second dynamics model. 
Furthermore, the second provisional instantaneous value for the desired movement is determined as the desired in- 
stantaneous value for the desired movement. 

[0099] In this case, in principle, the first dynamics model may be one with a relatively low dynamical approximation 
precision, and any dynamics model may be used as the second dynamics model as far as it has a higher dynamical 
approximation precision than the first dynamics model. Thus, the first model calculaling means and the second model 
calculating means (or performing calculations for their respective dynamics models can calculate the outputs of their 
respective dynamics models with a relatively small amount of calculation. And, since the floor reaction force manipu- 
lating quantity determined in such a manner that. the difference between the first provisional instantaneous value and 
the second provisional instantaneous value for the desired movement is close to 0 is additionally input to at least any 
one of the first dynamics model and the second dynamics model, the second provisional instantaneous value for the 
desired movement output from the second dynamics model allows the limitation-target quantity to fall within the allow- 
able range and is highly stable, and therefore, is suitable as the desired instantaneous value for the desired movement. 
As a result, besides a desired gait for normal walking, wide variety of desired gaits for running, walking on a floor of a 
low friction coefficient or the like, can be adequately generated with a relatively small amount of calculation. 
[0100] In the fortieth implementation, preferably, differences between the first provisional instantaneous value and 
the second provisional instantaneous value of the desired movement include a difference of the position of a prede- 
termined part of the robot, or include a difference of the position of the center of gravity of the robot and a difference 
of the posture of a predetermined part of the robot (forty-first implementation). In this case, a position/posture of the 
predetermined part and a position of the center of gravity of the robot which compromise the stability of the robot can 
be avoided, and thus, the stability of the robot for the desired instantaneous value for the desired movement can be 
improved. As the predetermined part, the body of the robot is preferable. 

[0101] The fortieth implementation described above can be readily realized using the twenty-sixth implementation, 
for example. That is, the twenty-sixth implementation without the means for determining a required value of the cor- 
rection quantity of the desired floor reaction force corresponds to the processing performed by the second model 
calculating means in the fortieth implementation. Thus, in the twenty-sixth implementation, the gait generation device 
further comprises third model calculating means that inputs at least the provisional instantaneous value of the desired 
floor reaction force to a third dynamics model, which represents a relationship between a movement and a floor reaction 
force of the robot, to determine a third provisional instantaneous value of the desired movement as an output of the 
third dynamics model, and the means for determining a required value of the correction quantity of the desired floor 
reaction force determines the required value based on the difference between the determined desired instantaneous 
value of the desired movement and the third provisional instantaneous value of the desired movement in such a manner 
that the difference is close to 0 (forty-second implementation). 

[0102] The third dynamics model and the third model calculating means in the forty-second implementation are 
equivalent to the first dynamics model and the first model calculating means in the fortieth implementation, respectively. 
Therefore, the forty-second implementation is equivalent to the fortieth implementation and can provide the same 
advantages as the fortieth implementation. 

Brief Description of the Drawings 

[0103] Figure 1 is a schematic diagram showing a whole arrangement of a two-legged mobile robot, which is a legged 
mobile robot according to an embodiment of the present invention; Figure 2 is a side view of a configuration of a foot 
portion of each leg of the robot shown in Figure 1 ; Figure 3 is a block diagram showing a configuration of a control unit 
provided in the robot shown in Figure 1 ; Figure 4 is a block diagram showing a functional arrangement of the control 
unit shown in Figure 3; Figure 5 is a diagram for illustrating a running gait for the robot shown in Figure 1 ; Figure 6 is 
a graph showing an example of setting of a desired floor reaction force' s vertical component; Figure 7 is a graph 
showing an example of setting of a desired ZMP; Figure 8 is a functional block diagram of essential parts of a gait 
generation device; Figures 9 and 10 are diagrams for illustrating movement modes (body translation mode and body 
rotation mode, respectively) of the robot; Figures 11 and 1 2 are diagrams for illustrating dynamics models of the robot. 
Figure 1 3 is a flowchart showing a main routine process performed by the gait generation device provided in the control 
unit shown in Figure 3; Figure 14 is a diagram illustrating a divergence state of the body position of the robot; Figure 
15 is a flowchart for illustrating a subroutine process in the flowchart shown in Figure 13; Figure 16 is a diagram 
illustrating a relationship between foot landing positions/postures in a normal gait and coordinate systems; Figure 17 
is a graph showing an example of setting of a desired floor reaction force's vertical component for the normal gait; 
Figure 18 is a graph showing an example of setting of a floor reaction force's horizontal component allowable range 
for the normal gait; Figure 1 9 is a graph showing an example of setting of a desired ZMP for the normal gait; Figure 
20 is a flowchart showing a subroutine process in the flowchart shown in Figure 13; Figure 21 is a flowchart showing 
a subroutine process in the flowchart shown in Figure 20; Figure 22 is a flowchart showing a subroutine process in the 
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flowchart shown in Figure 21 ; Figure 23 is a flowchart showing a subroutine process in the flowchart shown in Figure 
22; Figures 24 to 31 are graphs for illustrating essential processings in the flowchart shown in Figure 22; Figure 32 is 
a diagram showing an example of a trajectory of the body position for the normal gait; Figure 33 is a flowchart showing 
a subroutine process in the flowchart shown in Figure 13; Figure 34 is a graph showing an example of setting of the 

5 floor reaction force's horizontal component allowable range for a current time gait; Figure 35 is a flowchart showing a 
subroutine process in the flowchart shown in Figure 13; Figure 36 is a flowchart showing a subroutine process in the 
flowchart shown in Figure 35; Figure 37 is a flowchart showing a subroutine process in the flowchart shown in Figure 
36; Figure 38 is a flowchart showing a subroutine process in the flowchart shown in Figure 37; Figure 39 is a graph 
for illustrating essential processings in the flowchart shown in Figure 38: Figure 40 is a graph showing an example of 

10 setting of a floor reaction force's vertical component during walking; Figure 41 illustrates categories of gait correction 
methods used in essential parts of the present invention; Figure 42 is afunctional block diagram for illustrating a gait 
correction method according to a first embodiment of the present invention; Figures 43 and 44 are diagrams for illus- 
trating perturbation models; Figure 45 is a diagram showing an example of setting of a ZMP allowable range; Figures 
46 to 49 are diagrams for illustrating methods of limiting limitation -target quantities (a floor reaction force's horizontal 

15 component and a floor reaction force's moment); Figure 50 is a functional block diagram showing a gait correction 
method according to a second embodiment of the present invention; Figures 51 to 57 are diagrams for illustrating 
functions shown in the block diagram of Figure 50; Figure 58 is a functional block diagram showing a gait correction 
method according to a third embodiment of the present invention; Figure 59 is a functional block diagram showing a 
gait correction method according to a fourth embodiment of the present invention; Figure 60 is a diagram for illustrating 

20 a forward dynamics model according to a fifth embodiment of the present invention; Figure 61 is a functional block 
diagram showing a gait correction method according to the fifth embodiment of the present invention; Figure 62 is a 
functional block diagram showing a different method of correcting the body vertical position of the robot; and Figure 
63 is a diagram showing another movement mode of the robot. 

25 Best Mode for Carrying Out the Invention 

[0104] In the following, embodiments of a gait generation device and a control device for a legged mobile robot 
according to the present invention will be described with reference to the drawings. In the embodiments of the present 
invention, a two-legged mobile robot is taken as an example of the legged mobile robot. 
30 [01 05] Figure 1 is a schematic diagram showing a whole arrangement of a two-legged mobile robot, which is a legged 
mobile robot which uses a gait generation device and a control device according to an embodiment of the present 
invention. 

[0106] As shown in the drawing, a two-legged mobile robot (referred to as a robot, hereinafter) 1 comprises a pair 
of left and right legs (leg links) 2, 2 extending downward from a body 24. The legs 2, 2 have the same construction 
35 and each have six joints. In the order of increasing distance from the body 24, the six joints include a hip (waist) joint 
10R (10L) forconvolution (rotation) (rotation in the yaw direction with respect to the body 24), a hip (waist) joint 12R 
(12L) for rotation in the roll direction (about the X axis), a hip (waist) joint 14R (14L) for rotation in the pitch direction 
(about the Y axis), a knee joint 16R (16L) for rotation in the pitch direction, an ankle joint 18R (18L) for rotation in the 
pitch direction, and an ankle joint 20R (20L) for rotation in the roll direction. Reference symbols R and L indicate the 
right leg and the left leg, respectively. 

[0107] Under the two ankle joints 18R(L) and 20R(L) of each leg 2, a foot (foot portion) 22R(L) which constitutes the 
end portion of the leg 2 is attached. The body (base body) 24 is mounted on the top of the two legs 2, 2 via the hip 
joints 10R, 10L, 1 2R, 12L, 14R and 14L (three joints for each leg 2). The body 24 houses a control unit 26 and the 
like, which will be described in detail later. In Figure 1 , for the convenience of illustration, the control unit 26 is shown 

45 as being externa! to the body 24. 

[0108] In each leg 2 configured as described above, the hip joint (or waist joint) is composed of the joints 10R (L), 
12R (L) and 14R(L), and the knee joint is composed of the joint 16R(L), and the foot joint (ankle joint) is composed of 
the joints 1 8R(L) and 20R(L). The hip joint and the knee joint are connected to each other by a thigh link 28R(L), and 
the knee joint and the foot joint are connected to each other by a cms link 30R(L). 

50 [0109] Although not shown, a pair of left and right arms are attached to the upper part of the body 24 on either side 
thereof, and a head is mounted on the top of the body 24. Detailed description of the arms and the head is omitted in 
this specification, because they have no direct concern with the essence of the present invention. However, each arm 
has a plurality of joints and can make movements, such as back and forth swing with respect to the body 24, by the 
action the joints. 

55 [01 1 0] Configuring each leg 2 as described above provides the foot 22R (L) of the leg 2 with six degrees of freedom- 
with respect to the body 24. When the robot 1 moves, desired movements of the feet 22R and 22L can be realized by 
driving the twelve joints of the two legs 2, 2 (6*2=12) to appropriate angles (in this specification, the symbol "*" repre- 
sents multiplication of scalar operation or outer product of vector operation). Thus, the robot 1 can move arbitrarily in 
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a three-dimensional space. 

[0111] The "position" and "velocity" of the body 24 described later in this specification refer to the position of a pre- 
determined part of the body 24, specifically, a predetermined representative point of the body 24 (for example, a mid- 
point between the left and right hip joints) and the movement velocity of the point. Similarly, the "position" and "velocity" 
5 of each foot 22R(22L) refer to the position of a predetermined representative point of the foot 22R (22L) and the 
movement velocity of the point. In this embodiment, for example, the representative point of each foot 22R (22L) is set 
in the sole surface of the foot 22R (22L) (more specifically, a point at which a perpendicular line extending from the 
center of the ankle joints of each leg 2 to the sole surface of the foot 22R (22L) intersects with the sole surface, for 
example). 

10 [01 1 2] As shown in Figure 1 , each leg 2 has a well-known six-axis force sensor 34 disposed below the ankle joints 
18R(L) and 20R(L) and interposed between the ankle joints and the foot 22R(L). The six-axis force sensor 34 detects 
the presence of landing of the foot 22R (22L) of the leg 2, the floor reaction force (floor-contact load) applied to the leg 
2. and the like. The six axis force sensor outputs, to the control unit 26, detection signals of three directional components 
Fx, Fy and Fz of the translation force of the floor reaction force and three directional components Mx, My and Mz of 

15 the moment thereof. In addition, the body 24 has an inclination sensor 36 for detecting the inclination (posture angle) 
of the body 24 with respect to the Z axis (vertical direction (direction of gravity)) and the angular velocity thereof, and 
the inclination sensor 36 outputs the detection signals to the control unit 26. In addition, although not shown in detail, 
each joint in the robot 1 has an electric motor 32 for driving it (see Figure 3) and an encoder (rotary encoder) 33 (see 
Figure 3) for detecting the rotation amount of the electric motor 32 (rotation angle of the joint). The encoder 33 outputs 

20 the detection signal to the control unit 26. 

[0113] As shown in Figure 2, a spring mechanism 38 is provided above each foot 22R(L) and between the foot 22R 
(L) and the six-axis force sensor 34, and a foot sole elastic member 40 made of a rubber or the like is attached to the 
foot sole (bottom surface) of each foot 22R(L). The spring mechanism 38 and the foot soie elastic member 40 constitute 
a compliance mechanism 42. Specifically, the spring mechanism 38 comprises a rectangular guide member (not shown) 

25 mounted on the upper surface of the foot 22R(L) and a piston member (not shown) mounted on the same side as the 
ankle joint 1 8R (L) (the ankle joint 20R(L) is not shown in Figure 2) and the six-axis force sensor 34 and housed in the 
guide member in such a manner that the piston member can slightly move in the guide member due to an elastic 
member (such as a rubber or spring). 

[0114] The foot 22R(L) shown by the solid line in Figure 2 is in a state where no floor reaction force is applied to the 
30 foot. When a floor reaction force is applied to the leg 2, the spring mechanism 38 and the foot sole elastic member 40 
of the compliance mechanism 42 are distorted, thereby shifting the foot 22R (L) to a position/posture as indicatedby 
the dotted line in Figure 2. This configuration of the compliance mechanism 42 is important not only for reducing the 
landing impact but also for increasing the controllability of the robot 1 . Detailed description of the compliance mechanism 
is omitted herein, because it is described in detail in Japanese Patent Laid-Open No. 5-305584 previously proposed 
35 by the applicants. 

[0115] Furthermore, although not shown in Figure 1 , a joystick (manipulator) 44 (see Figure 3) for manipulating the 
robot 1 is provided externa! to the robot 1 . A request concerning the gait of the robot 1 , such as a request to turn the 
robot 1 moving straight ahead, can be entered to the control unit 26 as required by manipulating the joystick 44. In this 
case, requests that can be entered include those concerning the gait modes (walking gait, running gait or the like) of 
40 the robot 1 in motion, the landing position/posture or landing time of a free leg, and command data for prescribing the 
landing position/posture and landing time (for example, the movement direction of the robot 1 , the movement velocity 
thereof). 

[0116] Figure 3 is a block diagram showing an arrangement of the control unit 26. The control unit 26 is constituted 
by a microcomputer and comprises a first calculation unit 60 and a second calculation unit 62 (which constitute a CPU) , 

45 an A/D converter .50, a counter 56, a D/A converter 66, a RAM 54, a ROM 64 and a bus line 52 for data transmission 
among these components. In the control unit 26, the output signals from the six-axis force sensors 34 of the legs 2, 
the inclination sensor 36, the joystick 44 and the like are converted into digital values in the A/D converter 50 and then 
input to the RAM 54 via the bus line 52. Besides, the outputs from the encoders 33 (rotary encoders) at the joints of 
the robot 1 are input to the RAM 54 via the counter 56. 

50 [0117] As described later, the first calculation unit 60 generates a desired gait, calculates a joint angle displacement 
command (command value of the displacement angle of each joint or the rotation angle of each electric motor 32) and 
transmits the command to the RAM 54. The second calculation unit 62 reads, from the RAM 54 ? the joint angle dis- 
placement command and the measurement value of the joint angie indicated by the output signal of each encoder 33, 
calculates the operating amount of each joint to be driven and outputs the operating amount data to the electric motor 

55 32 that drives the joint via the D/A converter 66 and a servo amplifier 32a. 

[0118] Figure 4 is a block diagram showing a whole functional arrangement of the gait generation device and the 
control device of the robot 1 according to this embodiment. All the parts in Figure 4 except for the part designated as 
an "actual robot" are implemented by the functions performed by the control unit 26 (functions performed mainly by 
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the first calculation unit 60 and the second calculation unit 62). In the following description, the reference symbols R 
and L will be omitted if there is no need to discriminate between the left and right legs 2. 

[01 1 9] The control unit 26 has a full-model-correcting gait generation device 1 00 that generates and outputs a desired 
gait flexibly and in real time as described later (hereinafter abbreviated as a gait generation device 100). The gait 

5 generation device 1 00 has functions that implement means according to the present invention. The desired gait output 
from the gail generation device 100 comprises a corrected desired body posture trajectory (a trajectory of a desired 
posture of the body 24), a corrected desired body position trajectory (a trajectory of a desired position of the body 24), 
a desired foot position/posture trajectory (a trajectory of a desired position and a desired posture of each foot 22) , a 
desired arm posture trajectory (a trajectory of a desired posture of each arm), a desired ZMP (desired total floor reaction 

10 force central point) trajectory, a trajectory of a corrected desired floor reaction force's moment about a desired ZMP, 
and a desired total floor reaction force trajectory, if the body 24 has a movable member other than the legs 2 and the 
arms, a desired position/posture trajectory of the movable member is added to the desired gait. 

[0120] Here, the term "trajectory" means a time-varying pattern (time-series pattern), and is sometimes referred to 
also as a "pattern" in the following description, in addition, the term "posture" means a spatial orientation of each 

15 component. Specifically, for example, the body posture is represented by the inclination angle (posture angle) of the 
body 24 with respect to the Z axis (vertical axis) in the roll direction (about the X axis) and the inclination angle (posture 
angle) of the body 24 with respect to the Z axis in the pitch direction (about the Y axis), and the foot posture is repre- 
sented by the spatial azimuth angles of two axes set fixedly to each foot 22. In this specification, the body posture is 
sometimes referred to also as a body posture angle. 

20 [0121] The corrected desired body posture and the corrected desired bodyposition, details of which will be described 
later, are obtained by correcting, by full-model correction, a provisional desired body posture and a provisional desired 
body position generated by a simplified model, respectively. 

[0122] in the following description, the term "desired" will often be omitted as far as it causes no misunderstanding. 
The components of the gait other than those related to the floor reaction force, that is, the components related to the 

25 movement of the robot 1 , such as the foot position/posture and the body position/posture, are collectively referred to 
as a "movement". Furthermore, the floor reaction force applied to each foot 22 (the floor reaction force composed of 
the translation force and the moment) is referred to as an "each-foot floor reaction force", and the resultant force of 
the "each-foot floor reaction forces" applied to all (two) the feet 22R and 22L of the robot 1 is referred to as a "total 
floor reaction force". However, in the following description, there is made little mention of the each-foot floor reaction 

30 force, and therefore, the "floor reaction force" means the same as the "total floor reaction force" unless otherwise 
specified. 

[0123] In general, the desired floor reaction force is represented by the point of application, and the translation force 
and the moment applied to the point. The point of application can be set arbitrarily, so that one desired floor reaction 
force can be represented in an infinite number of ways. However, if the desired floor reaction force is represented by 
35 taking the desired floor reaction force central point (desired position of the central point of the total floor reaction force) 
as the point of application, the moment components of the desired floor reaction force are 0 except for the vertical 
component (the moment about the vertical axis (Z axis)). In other words, the horizontal moment components of the 
desired floor reaction force about the desired floor reaction force central point (the moments about the horizontal axes 
(X axis and Y axis)) are 0. 

40 [0124] Here, in a gait which satisfies the dynamical equilibrium condition, the ZMP (the point where the moments 
applied by the resultant force of the inertia! force and gravity applied to the point are 0 except for the vertical moment) 
calculated from the desired movement trajectory of the robot 1 agrees with the desired floor reaction force central point. 
Therefore, providing the desired floor reaction force central point trajectory means the same as providing the desired 
ZMP trajectory (for more information, see Japanese Patent Application No. 2000-352011 filed by the applicants). 

45 [0125] Based on such a background, in the specification of Japanese Patent Application No. 2000-352011 described 
above, the desired gait is defined as follows. 

(a) In a broad sense, the desired gait is a set of a desired movement trajectory and a desired floor reaction force 
trajectory for a period of one or more steps. 
50 (b) In a narrow sense, the desired gait is a set of a desired movement trajectory and a ZMP trajectory for a period 

of one step. 

(c) A gait series is a connection of several gaits. 

[0126] In walking, when the vertical position of the body 24 (body height) of the robot 1 is determined by the body 
55 height determination method previously proposed in Japanese Patent Laid-open No. 10-86080 by the applicants, the 
translation floor reaction force's vertical component is determined accordingly. Furthermore, if the body horizontal po- 
sition trajectory of the robot 1 is determined in such a manner that the horizontal component of the moment produced 
about the desired ZM P by the resultant force of the inertial force due to the movement with the desired gait and gravity 
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is 0, the translation floor reaction force's horizontal component is also determined. Therefore, in the specification of 
the Japanese Patent Application No. 2000-35201 1\ the physical value concerning the floor reaction force of the desired 
gait which has to be explicitly set is only the desired ZMP. Therefore, as the definition of the desired gait in a narrow 
sense, the definition (b) described above is sufficient. On the other hand, in a running gait of the robot 1 mainly described 
5 in this embodiment (details thereof will be described later), the floor reaction force's vertical component (the translation 
floor reaction force's vertical component) is also essential in controlling the robot. Therefore, in this embodiment, a 
desired trajectory of the floor reaction force's vertical component is explicitly set, and then, trajectories of the desired 
body's vertical position and the like of the robot 1 are determined. 

[0127) In addition, according to the present invention, a corrected desired floor reaction force's moment about the 
10 desired ZMP is produced. Thus, in this specification, the desired gait in a narrow sense is defined as follows (b") The 
desired gait in a narrow sense is a set of a desired movement trajectory, a desired ZMP trajectory, a corrected desired 
floor reaction force's moment about the desired ZMP and a floor reaction force's vertical component trajectory for a 
period of one step. 

[0128] In this specification, the "desired gait" means the desired gait in the narrow sense according to the definition 
(b n ), unless otherwise specified. However, as described in detail later, in the embodiments described in this specifica- 
tion as for a provisional desired gait generated in the process of generating a final desired gait, the corrected desired 
floor reaction force's moment about the desired ZMP is sometimes assumed to be 0 according to the original definition 
of the desired ZMP Thus, for the provisional desired gait other than the desired gait finally determined (for example, 
a simplified model's gait described later), the desired gait in the narrow sense according to the definition (b") described 
above minus the corrected desired floor reaction force's moment, that is, the gait according to the following definition 
(b' ) is sometimes used to mean the "desired gait", (b* )The desired gait in a narrow sense is a set of a desired movement 
trajectory, a desired ZM P trajectory and a floor reaction force's vertical component trajectory for a period of one step. 
[0129] In this specification, the term "one step" in the desired gait is used to mean a leg operation starting with landing 
of one leg 2 of the robot 1 and ending with landing of the other leg 2. In addition, in the following description, the "floor 
reaction force's vertical component" means the "translation floor reaction force's vertical component", and the vertical 
component of the moment of the floor reaction force (the component about the vertical axis) is discriminated from the 
"floor reaction force's vertical component" by using the term "moment". Similarly, the "floor reaction force's horizontal 
component" means the "translation floor reaction force's horizontal component". 

[0130] Furthermore, of course, a "two-leg supporting period" refers to a period in which the two legs 2, 2 support the 
weight of the robot 1 , a "one-leg supporting period" refers to a period in which either one of the legs 2, 2 supports the 
weight of the robot 1 , a "floating period" refers to a period in which both the legs 2, 2 are away from the floor (floating 
in the air). The leg 2 that doesn't support the weight of the robot 1 during the one-leg supporting period is referred to 
as a "free leg". In the running gait mainly described in this embodiment, there is no two-leg supporting period, and the 
one-leg supporting periods and the floating periods are repeated alternately. In this case, during the floating period, 
both the two legs 2 ; 2 don't support the weight of the robot 1 . However, the leg 2 that has been a free leg during the 
one-leg supporting period immediately preceding the floating period is referred to as a free leg during the floating 
period, and the leg 2 that has been a supporting leg during the one-leg supporting period immediately preceding the 
floating period is referred to as a supporting leg during the floating period. 

[0131] Now, taking as an example a running gait shown in Figure 5, a desired gait (in particular, movements of the 
legs 2, 2) generated by the gait generation device 100 will be described schematically. Here, other definitions and 
details concerning the gait are described in Japanese Patent Laid-Open No. 10-86081 previously proposed by the 
applicants, and therefore, the following is descriptions that are not made in Japanese Patent Laid-Open No. 1 0-86081 . 
[0132] First, the running gait shown in Figure 5 will be described. This running gait is one similar to atypical running 
gait of a human being In this running gait, the one-leg supporting periods in which the foot 22 of only one of the left 
and right legs 2 of the robot 1 (supporting leg) lands (is in contact with the floor) and the floating periods in which both 
the legs 2, 2 float in the air are repeated alternately. The first state in Figure 5 is a state (initial state) of the robot 1 at 
the start of a one-leg supporting period, the second state is a state thereof at the middle of the one-leg supporting 
period, the third state is a state thereof at the start of a floating period following the one-leg supporting period (the end 
of the one-leg supporting period), the fourth state is a state thereof at the middle of the floating period, and the fifth 
state is a state thereof at the end of the floating period (the start of the next one-leg supporting period). 
[0133] In this running gait, as shown in the first state in Figure 5, the robot 1 lands on the heel of the foot 22 of the 
supporting leg (the leading leg 2 of the robot 1 in the movement direction) at the start of the one-leg supporting period. 
Then, as shown in the second state in Figure 5, substantially the whole surface of the sole of the landing foot 22 (foot 
22 of the supporting leg) of the robot 1 comes into contact with the floor, and then, as shown in the third state in Figure 
5, the robot 1 jumps into the air by kicking the floor on the toe of the foot 22 of the supporting leg (foot 22 of the trailing 
leg 2 in the movement direction of the robot 1 in the third state shown in Figure 5). This is the time when the one-leg 
supporting period ends and the floating period starts. During the one-leg supporting period, the free leg, which is located 
rearward of the supporting leg at the start of the one-leg supporting period as shown in the first state in Figure 5, is 
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swung forward of the supporting leg toward a next expected landing position, as shown in the second and third states 
in Figure 5. Then, after the floating period shown as the fourth state in Figure 5, the robot 1 lands on the heel of the 
foot 22 of the free leg (leg 2 that has been the free leg during the one-leg supporting period immediately preceding the 
floating period) , and then, the next one-leg supporting period starts. 

5 [0134] With reference to the running gait in Figure 5, a desired gait generated by the gait generation device 100 will 
be described schematically. As described in detail later, when the gait generation device 1 00 generates a desired gait, 
basic required values (required parameters) for desired gait generation, such as landing position/posture (expected 
landing position/posture) and landing time (expected landing time) of the foot 22 of the free leg, are supplied to the 
gait generation device 1 00 via a required operation of the joystick 44 or the like. The gait generation device 1 00 gen- 

10 erates the desired gait using the required parameters. More specifically, based on the required parameters, the gait 
generation device 1 00 determines parameters (referred to as gait parameters) that define some of the components of 
the desired gait, such as the desired foot position/posture trajectory and the desired floor reaction force's vertical 
component trajectory for the desired gait, and then successively determines instantaneous values of the desired gait 
using the gait parameters, thereby generating a time-series pattern (trajectory) of the desired gait. 

15 [0135] In this case, the desired foot position/posture trajectory (more specifically, desired trajectories of spatial com- 
ponents (such as X axis component) of the position and posture of the foot) is generated for each foot 22 using the 
finite duration settling filter proposed by the applicants in Japanese Patent No. 3233450, for example. The finite duration 
settling filter is a series connection of plural (three or more, in this embodiment) stages of first-order delay filters of a 
variable time constant, that is, filters having a transmission function represented as 1 /(1 +xs) where x is a variable time 

20 constant (this filter is referred to as a unit filter, hereinafter). And, the finite duration settling filter can generate and 
output a trajectory that reaches to a specified value at a desired specified time. In this case, the time constant x of the 
unit filter of each stage is successively set in a variable manner based on the remaining time before the specified time 
after the definite duration settling filter starts generating the output. More specifically, as the remaining time decreases, 
the value of t decreases from a predetermined initial value (>0), and finally, at the specified time when the remaining 

25 time is 0, the value of t becomes 0. And, a step input having a height depending on the specified value (more specifically, 
the amount of variation of the output of the definite duration settling filter from the initial value to the specified value) 
is given to the definite duration settling filter. Such a definite duration settling filter can not only generate such an output 
that reaches to the specified value at the specified time but also have the variation rate of the output thereof being 0 
or substantially 0 at the specified time. In particular, if the unit filters are interconnected in three or more stages (three 

30 stages are enough), the variation acceleration (the differential value of the variation rate) of the output of the definite 
duration settling filter can be 0 or substantially 0. 

[0136] The generation of the foot position/posture trajectory (the position/posture trajectory of the foot 22 from a 
landing thereof to the next landing thereof) using such a definite duration settling filter is conducted in the following 
manner, for example. For example, the desired foot position traj ectory in the X axis direction (back-and-forth direction) 

35 is generated as follows. That is, the height of the step input to the definite duration settling filter is determined depending, 
on the X-axis directional position of the next expected landing position of each foot 22 (more specifically, the amount 
of variation (displacement) in the X axis direction of the next expected landing position with respect to the preceding 
landing position, this being equivalent to the specified value) which is determined by the required parameters, and the 
time constant x is initialized to a predetermined initial value. Then, the determined step input is given to the definite 

40 duration settling filter, and generation of the trajectory of the X-axis directional position of the foot 22 is started. During 
the trajectory generation , the time constant x is successively set in a variable manner so as to decrease from the initial 
value to 0 by the expected landing time of the foot 22 (which is equivalentto the specified time). In this way, the trajectory 
of the position of the foot 22 in the X axis direction that reaches to the expected landing position at the expected landing 
time is generated. 

45 [0137] Besides, the desired foot position trajectory in the Z axis direction (vertical direction) is generated in the fol- 
lowing manner, for example. Specifically, first, based on the next expected landing position and expected landing time 
of the foot 22, the Z-axis directional position of the foot 22 at the time when the foot 22 reaches the maximum height 
(vertical position) (referred to as a highest position, hereinafter) and the time required to reach the highest position are 
determined. Then, according to the highest position (which is equivalent to the specified value), the height of the step 

50 input to the definite duration settling filter is determined, and the time constantx is initialized. And then, the determined 
step input is given to the definite duration settling filter, and the foot position trajectory to the highest position in the Z 
axis direction is successively generated. In this regard, the time constant x is successively set in a variable manner so 
as to decrease from the initial value to 0 by the time when the highest position is reached (this time being equivalent 
to the specified time). Furthermore, when the generation of the trajectory to the highest position in the Z axis direction 

55 is completed, the time constant x is initialized, a step input of the polarity opposite to that of the step input having been 
used (more specifically, a step input of the opposite polarity having a height depending on the amount of variation in 
the Z axis direction from the highest position to the next expected landing position (th is being equivalent to the specified 
value)) is input to the definite duration settling filter, and the foot position trajectory in the Z axis direction from the 
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highest position to the expected landing position is successively generated. In this regard, the time constant x is suc- 
cessively set in a variable manner so as to decrease from the initial value to 0 by the expected landin g time of the foot 22 . 
[0138] When generating the foot position trajectory in the Z axis direction, the time constant t may be set in a variable 
manner so as to decrease from the initial value to 0 in a period from the start of the trajectory generation to the expected 
5 landing time of the foot 22, and the polarity of the step input may be switched to the opposite one at the time when the 
highest posiLion is reached or Lhe time in Ihe vicinity thereof. In Ihis case, although the fool 22 cannot reach to a desired 
highest position with a high precision, the fool 22 can reach the expected landing position at the expecled landing time 
without problems. 

[0139] The foot posture trajectory can be generated using the definite duration settling filter, as with the foot position 
10 trajectory described above. In this case, as for a spatial component of the foot posture whose posture angle variation 
is monotonic (monotonically increasing or monotonically decreasing) , the foot posture trajectory can be generated in 
the same manner as the foot position trajectory in the X axis direction described above. Besides, as for a spatial 
component of the foot posture whose posture angle variation has a maximum value or minimum value, the foot posture 
trajectory can be generated in the same manner as the foot position trajectory in the Z axis direction described above. 
15 [0140] Here, the desired foot position/posture trajectory generated using the definite duration settling filter as de- 
scribed above is the desired position/posture trajectory of each foot 22 in a supporting leg coordinate system fixed on 
the floor surface described later. 

[0141] The desired foot position/posture trajectory generated as described above is configured so that the position 
of each foot 22 starts moving by gradually accelerating from the initial floor-contact state (the state at the start time in 

20 the desired gait) toward the expected landing position. In addition, the desired foot position/posture trajectory is con- 
figured so that the variation rate of the foot position is gradually reduced and finally reaches to 0 or substantially 0 at 
the expected landing time, and the foot reaches to the expected landing position at the expected landing time and 
stops moving. Thus, at the instant when each foot 22 lands, the velocity thereof with respect to the floor (the variation 
rate of the position of the foot 22 in the supporting leg coordinate system fixed on the floor) is 0 or substantially 0. 

25 Therefore, if the foot lands from a state where both the legs 2, 2 float in the air (state during the floating period) in the 
running gait, it is subject to a reduced landing impact. 

[0142] In the running gait, the vertical velocity of the body 24 is downward in the later half of the floating period 
because of gravity applied to the robot 1 , and the vertical velocity remains downward at the time of landing. Therefore, 
if the desired foot position/posture trajectory is generated in such a manner that the velocity of the foot 22 with respect 
30 to the floor at the instant of landing is 0 or substantially 0, and the desired position/posture trajectory of the body 24 is 
generated so as to satisfy the dynamical equilibrium condition as described later the relative velocity of the foot 22 of 
the free leg with respect to the body 24 is upward at the time immediately before landing. That is, at the instant of 
landing in the running gait, the desired gait of the robot 1 is one in which the robot 1 lands at the floor while retracting 
the free leg 2 to the body 24. In other words, in the desired gait in this embodiment, the robot 1 lands by retracting the 
35 foot 22 of Lhe free leg toward the body 24 so that the foot 22 has a velocity with respect to the floor of 0 or substantially 
0 at the instant of landing. Thus, the landing impact is reduced and prevented from being excessive. 
[0143] In this embodiment, since the definite duration settling filter is a series connection of three or more (three, for 
example) stages of unit filters, the velocity of each foot 22 (variation rate of the position of the foot) is reduced to 0 or 
substantially 0 by the expected landing time, and the acceleration of each foot 22 is also reduced to 0 or substantially 
40 o at the expected landing time, so that the foot 22 stops moving. That is, the acceleration with respect to the floor is 
also 0 or substantially 0 at the instant of landing. Thus, the landing impact is further reduced. In particular, even if the 
actual landing time of the robot 1 varies from the desired landing time, the impact doesn't increase significantly. Inci- 
dentally, in order to simply make the velocity of each foot 22 with respect to the floor 0 or substantially 0 at the expected 
landing time, the definite duration settling filter may be composed of two stages of unit filters. However, in this case, 
45 the acceleration of each foot 22 is not 0 at the expected landing time typically. 

[0144] Here, the foot posture continues to change after the foot 22 lands on the heel at the expected landing time 
until substantially the whole surface of the sole of the foot 22 comes into contact with the floor. Therefore, the foot 
posture trajectory is generated using the definite duration settling filter by setting the time when substantially the whole 
surface of the sole of the foot 22 comes into contact with the floor as the specified time. 

[0145] Furthermore, while the definite duration settling filter is used to generate the foot position trajectory in this 
embodiment, the desired foot position trajectory may be generated using a function , such as a polynomial that is defined 
so that the variation rate of the foot position is 0 or substantially 0 (the time differential value of the foot position is 0) 
at the expected landing time, and the variation acceleration of the foot position (the time differential value of the variation 
rate) is 0 or substantially 0 at the expected landing time. This holds true for the generation of the desired foot posture 
trajectory. However, for generation of the desired foot posture trajectory, the function, such as a polynomial, is defined 
so that the variation rate of the posture of each foot 22 and the variation acceleration thereof are 0 or substantially 0 
at the time when substantially the whole surface of the sole of the foot 22 comes into contact with the floor as described 
above. 
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[0146] The desired floor reaction force's vertical component trajectory is set as shown in Figure 6, for example. In 
this embodiment the shape of the desired floor reaction force's vertical component trajectory in the running gait (spe- 
cifically, the shape thereof in the one-leg supporting period) is prescribed to be trapezoidal (protruding in the direction 
of the floor reaction force's vertical component increasing). The height of the trapezoid and the times of the apexes of 

5 the trapezoid are determined as gait parameters (floor reaction force's vertical component trajectory parameters) for 
defining the desired floor reaction force's vertical component trajectory. Here, during the floating period in the running 
gait, the desired floor reaction force's vertical component is constantly set to 0. As in this example, the desired floor 
reaction force's vertical component trajectory is preferably set to be substantially continuous (i.e. not to have discon- 
tinuous values). This is intended to make the joints of the robot 1 move smoothly when controlling the floor reaction 

10 force. Here, the words "substantially continuous" imply that a trajectory doesn't lose its continuity because of discrete 
values that inevitably occur when a continuous analog trajectory (continuous trajectory in the true sense) is converted 
into a digital trajectory in a discrete-time system. 

[0147] Basically, the desired 2MP trajectory is set as follows. In the running gait shown in Figure 5, the robot t lands 
on the heel of the foot 22 of the supporting leg. then jumps into the air by kicking the floor on the toe of the foot 22 of 

15 the supporting leg, and finally lands on the heel of the foot 22 of the free leg, as described above. Therefore, the desired 
ZMP trajectory during the one-leg supporting period is set so that the desired ZMP is initially positioned at the heel of 
the foot 22 of the supporting leg 2, shifted to the longitudinal middle point of the foot 22 in the period in which substantially 
the whole surface of the sole of the foot 22 of the supporting leg is in contact with the floor, and then shifted to the toe 
of the foot 22 of the supporting leg by the time when the foot takes off the floor, as shown in the upper part of Figure 

20 7. Here, the upper part of Figure 7 shows the desired ZMP trajectory in the X axis direction (back and forth direction), 
and the lower part of Figure 7 shows the desired ZMP trajectory in the Y axis direction (sideward direction). As shown 
in the lower part of Figure 7, the desired ZMP trajectory in the Y axis direction during the one-leg supporting period is 
set in such a manner that the desired ZM P is at the same position as the central point of the ankle joints of the supporting 
leg 2 in the Y axis direction. 

25 [0148] As shown in the upper part of Figure 7, the X axis-directional position of the desired ZMP trajectory during 
the floating period is adapted to continuously shift from the toe of the foot 22 of the supporting leg to the landing position 
of the heel of the foot 22 of the free leg by the time of the next landing of the free leg 2. Furthermore, as shown in the 
lower part of Figure 7, the Y axis-directional position of the desired ZM P trajectory during the floating period is adapted 
to continuously shift from the Y axis-directional position of the center of the ankle joints of the supporting leg 2 to the 

30 Y axis-directional position of the center of the ankle joints of the free leg 2 by the time of the next landing of the free 
leg 2. That is, the desired ZMP trajectory is made continuous (substantially continuous) for the whole period of the 
gait. Here, the words "substantially continuous" used for representing the ZMP trajectory have the same meaning as 
in the floor reaction force's vertical component trajectory described above. 

[0149] Taking into consideration the approximation precision of the dynamics model used for generating the desired 
35 gait, in order to make the desired movement with the desired gait as continuous as possible, the desired ZMP trajectory 
is preferably substantially continuous even during the floating period as described above. However, the dynamics 
model used in this embodiment, which will be described later, the desired ZMP trajectory is not necessarily required 
to be continuous. In addition, in this embodiment, the positions and times of the apexes of the desired ZMP trajectory 
such as shown in Figure 7 are set as ZMP trajectory parameters (parameters defining the desired ZMP trajectory). 
40 [0150] The desired arm posture is represented as a relative posture with respect to the body 24. 

[0151] The desired body position/posture, the desired foot position/posture and a reference body posture described 
later are described in a global coordinate system. The global coordinate system is a coordinate system that is fixed to 
the floor. More specifically, a supporting leg coordinate system described later is used as the global coordinate system. 
[0152] In this embodiment, the gait generation device 100 generates not only the desired body posture but also a 
45 reference body posture. The reference body posture is a body posture that is generated complying with a gait request 
(request to the gait generation device 1 00 from another device, such as a behavior planning unit, or from the outside 
(via the joystick 44 or the like)). 

[0153] The desired body posture (hereinafter, the "body posture" without the word "reference" refer to the desired 
body posture) is generated so as to follow or agree with the reference body posture in the long term. 

50 [0154] Figure 8 is a block diagram for illustrating details of the gait generation device 1 00. With reference to Figure 
8, a process performed by the gait generation device 100 will be schematically described below. 
[0155] As shown, the gait generation device 100 has a gait parameter determinator 100a. The gait parameter de- 
terminator 100a determines the values of parameters of a desired gait (parameters defining a desired gait) or a time- 
series table thereof. This process corresponds to steps S018 to S030 in the flowchart shown in Figure 13, which will 

55 be described later. 

[0156] As described in detail later, parameters determined by the gait parameter determinator 100a include param- 
eters that define the desired foot position/posture trajectory, the desired arm posture trajectory, the reference body 
posture trajectory, the desired ZMP trajectory, the desired floor reaction force's vertical component trajectory and the 
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like, as welt as a parameter that defines the floor reaction force's horizontal component allowable range and a parameter 
that defines a 2MP allowable range. In this case, according to this embodiment, two types of floor reaction force's 
horizontal component allowable ranges are set, one of which is for the simplified model gait and set in the processing 
in step S026, and the other of which is for gait correction and set in the processing in step S030. On the other hand, 
5 there is only one ZMP allowable range which is for gait correction and set in the processing in step S030. 
[0157] Now. Ihe ZMP allowable range will be described briefly. 

[0158] As described later, the desired gait is corrected so as to produce a corrected desired floor reaction force's 
moment about the desired ZMP. Therefore, the desired ZMP is different from the point according to the original definition 
(i.e., the definition that the ZMP is a point where the floor reaction force's moment horizontal component is 0). The 
10 ZMP that satisfies the original definition is displaced from the desired ZMP by a distance derived from dividing the 
corrected desired floor reaction force's moment by the desired floor reaction force's vertical component. In the following 
description, the ZMP that satisfies the original definition will be referred to as a "true ZMP". 

[0159] The true ZMP of the corrected gait has to lie at least within the ZMP possible range (that is, the so-called 
supporting polygon, the possible range of the point of application of the floor reaction force (ZMP) in the case where 
15 it is assumed that there is no adhesion force between the floor and the sole of the foot 22). Furthermore, in order to 
allow an adequate stability margin for the robot 1 . the true ZMP of the corrected gait preferably lies in the vicinity of 
the center of the ZMP possible range. Thus ; in this embodiment, an allowable range within which the true ZMP of the 
corrected gait can lie is set. This range is referred to as a ZMP allowable range. 

[0160] The ZMP allowable range is set so as to agree with or be contained in the ZMP possible range. A manner of 

20 setting the ZMP allowable range will be described in detail later. 

[01 61 ] The gait parameters determined by the gait parameter determinator 1 00a are input to a desired instantaneous 
value generator 100b. Based on the input gait parameters, the desired instantaneous value generator 100b succes- 
sively calculates (generates) the instantaneous values, at the present time t, of the desired foot position/posture, the 
desired ZMP, the desired floor reaction force's vertical component, the desired arm posture, the desired total center- 

25 of-gravity vertical position, the desired body vertical position, the floor reaction force's horizontal component allowable 
range, the ZMP allowable range and the reference body posture angle (Figure 8 shows only some of the desired 
instantaneous values). This process in the desired instantaneous value generator 100b corresponds to steps S900 to 
S91 0 in Figure 37 that are performed in the procedure of step S032 in the flowchart shown in Figure 1 3 described later 
and to steps S034 and S036 in Figure 13. In this embodiment, some of the desired instantaneous values calculated 

30 by the desired instantaneous value generator 1 00b (specifically, the instantaneous value of the desired body vertical 
position) are provisional ones, which are to be corrected at a later time. Furthermore, the desired instantaneous value 
generator 1 00b calculates two instantaneous values for the floor reaction force's horizontal component allowable range, 
one of which is for the simplified model gait, and the other of which is for gait correction. 

[0162] The desired instantaneous values (some of which are provisional ones) calculated (generated) by the desired 
35 insLantaneous value generator 100b are input to a full model correction unit 100c. The full model correction unit 100c 

has a simplified model 100c1 and a full model 100c2 as dynamics models. The full model correction unit 100c uses 

the simplified model 100c1 to determine the provisional instantaneous value of the desired body position/posture and 

the like from the input values and then corrects the determined provisional instantaneous value of the body position/ 

posture and the like using the full mode! 1O0c2. 
40 [0163] The full model correction unit 1 00c may have no simplified model 1 00c 1 . The full model 1 00c2 is either of an 

inverse full model (inverse dynamics full model) or forward full model (forward dynamics full model), as described later. 

[0164] More specifically, the full model correction unit 100c performs a processing B1 or B2 so as to satisfy the 

following conditions A1 to A3. That is, in order to satisfy the conditions that: 

45 (A1 ) the dynamical equilibrium condition is satisfied with a higher precision than the gait generated based simply 

on the simplified model (hereinafter, referred to as a simplified model gait); 

(A2) the true ZMP (ZMP satisfying the original definition that is corrected by producing the corrected desired floor 
reaction force's moment about the desired ZMP) lies within the ZMP allowable range (ailowable.range that allows 
the stability margin to be adequately maintained); and 

(A3) the floor reaction force's horizontal component falls within the floor reaction force's horizontal component 
allowable range for gait correction, the full model correction unit 100c: 

(B1 ) corrects the body position/posture of the simplified model gait determined using the simplified model; 

or 

55 ( B 2) corrects the body position/posture of the simplified model gait determined using the simplified model and 

outputs the corrected desired floor reaction force's moment about the desired ZMP (corrects the desired floor 
reaction force). 
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[0165] The corrected desired floor reaction force's moment about the desired ZMP may be converted into a ZMP 
converted value according to the formula b01 described above. In addition, theZMP allowable range may be converted 
into a corrected desired floor reaction force's moment allowable range according to the formula b01 . 
[0166] Since the legs 2, 2 of the robot 1 have twelve joints as shown in Figure 1, a desired joint displacement is 
5 uniquely determined from the positions/postures of the feet 22R and 22L and the body position/posture by an inverse 
kinematics calculation as described later. That is, a current time's desired posture of the robot 1 (a desired posture of 
the robot 1 at the present time t) is uniquely determined. 

[0167] The instantaneous values (instantaneous posture) of the corrected desired gait are input to a composite- 
compliance controller (the part indicated by the dashed line in Figure 4), and the controller controls the joint actuators 
10 (electric motors 32) so that the actual robot 1 follows the desired gait while keeping its balance. 

[0168] The foregoing is schematic description of the configuration and operation of the device according to this 
embodiment. 

[0169] Now, body movement modes used for gait generation in this embodiment and the simplified model will be 
described. 

15 [0170] In the case of gaits having a floating period, such as a running gait, or gaits of walking on a floor of a low 
friction coefficient, the technique of simply adjusting the body's horizontal acceleration, such as one previously proposed 
by the applicants in Japanese Patent Application No. 2000-352011 , may not adequately satisfy the dynamical equilib- 
rium condition while keeping the floor reaction force's horizontal component of the desired gait falling within the allow- 
able range (or friction limit). Thus, in this embodiment, two movement modes of the body 24 (a body translation mode 

20 and a body rotation mode) , which are described below, are generated in a composite manner, thereby satisfying the 
dynamical equilibrium condition while keeping the floor reaction force's horizontal component of the desired gait falling 
within the allowable range (or friction limit). 

[0171] As shown in Figure 9, if only the body's horizontal acceleration is brought into perturbation from a certain 
movement state, the total center-of-gravity horizontal acceleration and the angular momentum about the total center 

25 of gravity are brought into perturbation. That is, the perturbation of the body's horizontal acceleration causes pertur- 
bation of the floor reaction force's moment about the desired ZMP (excluding the component about the vertical axis) 
and the floor reaction force's horizontal component (strictly, the translation floor reaction force's horizontal component) 
without causing perturbation of the floor reaction force's vertical component (which is in balance with the resultant force 
of the inertia! force and gravity caused by the perturbation of the body's horizontal acceleration in a dynamical sense). 

30 This movement mode is referred to as a body translation mode. 

[0172] In other words, referred to as a body translation mode is such a movement that causes changes of the hori- 
zontal component of the floor reaction force's moment about the desired ZM P and the floor reaction force's horizontal 
component (translation floor reaction force's horizontal component) without causing any change of the floor reaction 
force's vertical component. 

35 [0173] A variation of the floor reaction force moment's component per unit acceleration is denoted by AMp, and a 
variation of the floor reaction force's horizontal component per unit acceleration is denoted by AFp. If the body 24 is 
horizontally accelerated in the forward direction in the situation shown in Figure 9, AMP and AFp are applied in the 
directions indicated by the arrows in Figure 9, respectively. 

[0174] While, in order to be perceptually more readily understood, the body translation mode is represented using 
40 the floor reaction force balanced with the resultant force of the inertial forceandgravitycausedbythemovement, repre- 
senting the same using the resultant force of the inertial force and gravity is more accurate theoretically. Here, the 
resultant force and the floor reaction force have the same magnitude and the opposite directions. 

[0175] The ratio of AMp to AFp is referred to as a body translation mode floor reaction force ratio h. That is : the body 
translation mode floor reaction force h is defined by the following formula. 



h = AMp/Fp formula a7 

[0176] On the other hand, as shown in Figure 10, if the body posture angular acceleration is brought into perturbation 
about a certain point Pr from a certain movement state, the total center of gravity is not brought into perturbation, but 
the angular momentum about the total center of gravity is brought into perturbation. That is, the perturbation of the 
body posture angular acceleration about the point Pr causes perturbation of the horizontal component of the floor 
reaction force's moment about the desired ZMP, without causing perturbations of the floor reaction force's vertical 
component and the floor reaction force's horizontal component (strictly, the translation floor reaction force's vertical 
component and the translation floor reaction force's horizontal component). This movement mode is referred to as a 
body rotation mode. 

[0177] In other words, referred to as a body rotation mode is such a movement that causes a change of the horizontal 
component of the floor reaction force's moment about the desired ZM P without causing any changes of the floor reaction 
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force's vertical component and the floor reaction force's horizontal component. 

[0178] A variation of the floor reaction force moment' s component per unit acceleration is denoted by AMr, and a 
variation of the floor reaction force's horizontal component per unit acceleration is denoted by AFr. AFr is 0. If an angular 
acceleration is applied to the body to cause the body to incline forward in the situation shown in Figure 10, AMr is 
5 applied in the direction indicated by the arrow in Figure 10. 

[01 79] Besides the body translation mode and the body rotation mode ; the movement of Ihe body 24 includes a body 
vertical movement mode. This mode makes Ihe body 24 move in the vertical direction. 

[0180] The desired instantaneous value generator 1 00b generates a gait using the simplified (dynamics) mode] de- 
scribed below. The simplified model is a dynamics model that gives priority to reduction of the calculation amount and 
10 easiness of behavior analysis rather than dynamical precision. It may neglect some dynamical considerations (a var- 
iation of the angular momentum about the center of gravity, for example) or may contain some contradiction (inaccu- 
racy), 

[0181] Figure 11 shows an example of the simplified dynamics model (simplified model). As shown, this dynamics 
model has three material particles in total, including two material particles 2m ; 2m corresponding to the legs 2, 2 of 
15 the robot 1 , respectively ; and a material particle 24m corresponding to the body 24, and a flywheel FH having a certain 
inertia and no mass. This dynamics model is a decoupled one ; that is, the dynamics of the legs 2, 2 (dynamics of the 
material particles 2m, 2m) and the dynamics of the body 24 (dynamics of the material particle 24m and the flywheel 
FH) don't interfere with each other, and the dynamics of the whole robot 1 is represented by a linear coupling of these 
dynamics. In addition, the relationship between the movement of the body 24 and the floor reaction force is separated 
into the relationship between the translation movement of the body 24 (in the body translation mode) and the floor 
reaction force and the relationship between the rotation movement of the body 24 (in the body rotation mode) and the 
floor reaction force. Specifically, the floor reaction force caused by horizontal movement of the body material particle 
24m corresponds to the floor reaction force caused by horizontaltranslation movement of the body 24 (in the body, 
translation mode), and the floor reaction force caused by rotation movement of the flywheel corresponds to the floor 
reaction force caused by rotation of the posture angle of the body 24 (in the body rotation mode). 
[01 82] Here, the mass of the arms of the robot 1 is included in the mass of the body 24, and the body material particle 
24m has a mass including the mass of the arms. In this embodiment, the movement (swing movement) of the arms of 
the robot 1 in the desired gait is attained in such a manner that it cancels the inertial force's moment about the vertical 
axis produced in the robot 1 by the movements other than the swing movement and keeps fixed the relative position 
of the center of gravity of the both arms with respect to the body 24. Thus, effects of the swing movement of the arms 
on the floor reaction force moment (except for the component thereof about the vertical axis) and the floor reaction 
force's horizontal component are neglected 

[01 83] In the following, the simplifiedmodel will be formulated. In this regard, for the sake of simplicity of explanation, 
only the equation of motion in the sagittal plane (the plane containing the back-and-forth axis (X axis) and the vertical 
axis (Z axis)) is described, and the equation of moLion in the lateral plane (the plane containing the sideward axis (Y 
axis) and the vertical axis (Z axis)) is omitted. 

[0184] For convenience of explanation, variables and parameters concerning the dynamics model are defined as 
follows. Each of the material particles 2m, 2m and 24m is a representative point of its corresponding part or a point 
geometrically uniquely determined from the position/posture of the part. For example, the position of the material particle 
2m for the supporting leg 2 is located above the representative point of the sole of the foot 22 of the leg 2 by a prede- 
termined distance. 

Zsup: supporting leg material particle's vertical position 
Zswg: free leg material particle's vertical position 

Zb: body material particle's vertical position (typically different from the body's vertical position) 
ZGtotal: total center- of- gravity vertical position 
Xsup: supporting leg material particle's horizontal position 
Xswg: free leg material particle's horizontal position 

Xb: body material particle's horizontal position (this is a point which is shifted from the point Pr in the back-and- 
forth direction by a predetermined distance. The shift is determined so that the center of gravity in a strict model 
and the center of gravity in this dynamics model agree with each other as precisely as possible when the robot 
stands upright, for example. The body material particle's horizontal position is typically different from the body 
horizontal position.) 

XGtotal: total center-of-gravity horizontal position 

G by: body posture angle about the Y axis with respect to the vertical direction (inclination angle) 
mb: body material particle's mass 
msup; supporting leg material particle's mass 
mswg: free leg material particle's mass 
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mtotal: total robot mass (=mtotal+msup+mswg) 

J: body's moment of inertia (This is an equivalent moment of inertia in the body rotation mode.) Typically, this 
doesn't agree with the moment of inertia of the body 24 of the actual robot 1 .) 

Fx; floor reaction force's horizontal component (specifically, the back-and-forth (X axis) component of the transla- 
tion floor reaction force) 

Fz: floor reaction force's vertical component (specifically, the vertical (Z axis) component of the translation floor 
reaction force. In this embodiment, this equals to the desired translation floor reaction force's vertical component) 
My: floor reaction force moment about the desired ZMP (specifically, the component of the floor reaction force 
moment about the sideward axis (Y axis)) 



[0185] In this embodiment, the relationship between the position of the material particle 2m of each leg 2 and the 
position of the foot 22 of the leg 2 (position of a predetermined representative point of the foot 22) is previously pre- 
scribed, and thus, if the position of either one of them is determined, the position of the other is uniquely determined. 
In addition, the relationship between the position of the body material particle 24m and the position of the body 24 
15 (position of a predetermined representative point of the body 24) is previously prescribed in accordance with the posture 
angle of the body 24, and thus, if one of the positions and the posture angle are determined, the position of the other 
is uniquely determined. 

[0186] In addition, for an arbitrary variable X, dX/dt represents the first order differential of X, and d2X/dt represents 
the second order differential of X. Thus, if the variable X represents a displacement, dX/dt represents the velocity, and 
20 d2X/dt represents the acceleration. The character g denotes the coefficient of the acceleration of gravity. Herein, g is 
a positive value. 

[0187] The equations of motion for the dynamics model (formulas representing the dynamical equilibrium condition) 
are represented by the formulas a8, a9 and a10. 



Fz - mb*(g + d2Zb/dt2) + msup*(g + d2Zsup/dt2) 

+- mswg*(g » d2Zswg/dt2) formula a8 

Fx = mb*d2Xb/dt2 + msup*d2Xsup/dt2 4- mswg*d2Xswg/dt2 formula a9 

My - -mb* (Xb - Xzmp) * (g+d2Zb/dt2) + rnb* (Zb - Zzmp) *(d2Xb/dt2) 

- msup*(Xsup - Xzmp)*(g + d2Zsup/dt2) 
4- msup*(Zsup - Zzmp)*(d2Xsup/dt2) 

- mswg*(Xswg - Xzmp)*(g + d2Zswg/dt2) 

+ mswg*(Zswg - Zzmp)*(d2Xswg/dt2) + J*d2eby/dt2 formula a1 0 

[0188] In addition, as for the center of gravity of the whole robot, the following relational formulas hold. 

ZGtotal = (mb*Zb + msup*Zsup + mswg*Zswg)/mtota! formula b1 1 

XGtotal = (mb*Xb + msup*Xsup +- mswg*Xswg)/mtotal formula b12 

[0189] The following are relationships between the dynamics model and AFp, AMp, AFr and AMr. 

[0190] AFp is a perturbation amount of Fx provided when d2Xb/dt2 is brought into perturbation by a unit amount in 

the formula a9 and, thus, can be determined by the following formula. 

AFp = mb formula c06 
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That is ; the variation AFp of the horizontal component of the floor reaction force per unit acceleration in the body 
translation mode is equivalent to the mass of the body material particle 24m in the dynamics model. 
[0191] AMp is a perturbation amount of My provided when d2Xb/dt2 is brought into perturbation by a unit amount in 
the formula a10 and, thus, can be determined by the following formula, 

5 

AMp = mb*(Zb - Zzmp) formula c07 

That is. the variation AMp of the floor reaction force moment's component per unit acceleration in the body translation 
10 mode is the product of the bodymaterial particle mass in the dynamics model and the height (vertical position) of the 
body material particle 24m from the desired ZMP. The relationship between the positions of the body material particle 
24m and the desired ZMP and the movement of the body material particle 24m is equivalent to the behavior of an 
inverted pendulum, the body material particle 24m being assumed to be the material particle of the inverted pendulum 
and the desired ZMP being assumed to be the fulcrum of the inverted pendulum. 
15 [0192] AFr is a perturbation amount of Fx provided when d2Bby/dt2 is brought into perturbation by a unit amount in 
the formula a9 and, thus ; can be determined by the following formula. 
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AFr^O formula c08 

That is. the variation AFr of the translation floor reaction force's horizontal component per unit acceleration in the body 
rotation mode is 0. 

[0193] AMr is a perturbation amount of My provided when d2eby/dt2 is brought into perturbation by a unit amount in 
the formula a1 0 and, thus, can be determined by the following formula. 

AMr = J formula c09 



That is. the variation AMr of the floor reaction force moment component per unit acceleration in the body rotation mode 
30 is equivalent to the moment of inertia of the flywheel. 

[0194] As described in detail later, generation of a gait using the simplified dynamics model in the above-mentioned 
example (a simplified model gait) is conduced under the following procedure. 

[0195] First, based on the feet position/posture trajectory and the desired floor reaction force's vertical component 
calculated from the gait parameters, the body vertical acceleration is determined using the formula a8. In addition, the 
35 body vertical acceleration is integrated two times to find the body' s vertical position Zb in the body vertical movement 
mode. 

[0196] Finally, usingthe formulas a9 and a10, the body horizontal acceleration d2(Xb)/dt2 and the body posture 
angular acceleration d2 (0b)/dt2 are determined in such a manner that the floor reaction force's horizontal component 
falls within the allowable range (the floor reaction force's horizontal component allowable range for the simplified model 
40 gait). Furthermore, these accelerations are integrated two times to determine the body horizontal position Xb in the 
body translation mode and the body posture angle 8b in the body rotation mode (specifically, provisional instantaneous 
values thereof). 

[01 97] Generally speaking, the gait obtained using the simplified dynamics model (simplified model gait) is generated 
by calculating the body position trajectory and the body posture angle trajectory, based on the feet position/posture 

45 trajectory, the desired ZMP and the desired floor reaction force's vertical component which are determined from the 
gait parameters, in such a manner that the moment about the desired ZMP applied by the resultant force of gravity 
and the inertial force is 0, the sum of the translation force's vertical component of the resultant force of gravity and the 
inertial force and the desired floor reaction force' s vertical component is 0, and the desired floor reaction force's 
horizontal component (that is, the translation force's horizontal component of the resultant force of gravity and the 

50 inertial force which is inverse in sign) falls within the floor reaction force horizontal component allowable range. 

[0198] In the embodiments described in this specification, the word "full model" means a robot dynamics model 
different from that used for determining the current time gait parameters. The full model is preferably a robot dynamics 
model that has a higher approximation precision than the model used for determining the current time gait parameters. 
In the example shown in the drawings, in this embodiment, the simplified model shown in Figure 11 is used to determine 

55 the current time gait parameters. Therefore, it is preferable that a robot dynamics model having a higher approximation 
precision, such as a multi-mass model shown in Figure 12 (a model having a material particle at each of the links in 
the robot 1 ) , is used as the full model. In this case, the full model may be one in which a moment of inertia is set about 
a material particle. 
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[0199] However the simplified model and the full model are not necessarily required to have different approximation 
precisions. The simplified model and the full model may use the same dynamics equations as far as they use different 
floor reaction force horizontal component allowable ranges. That is, only needed is that the allowable range for the 
simplified model gait and the allowable range for gait correction are different from each other. For example, it may be 
5 enough to set wide the floor reaction force horizontal component allowable range in generating a gait using the simplified 
model (it may exceed the friction limit) and set narrow the floor reaction force horizontal component allowable range 
in correcting the gait using the full model to prevent the robot from slipping. 

[0200] In this specification, the model used for calculating (outputting) the body position/posture based on (by re- 
ceiving) the desired foot position/posture and the desired floor reaction force (in particular, the desired ZMP and the 

10 desired floor reaction force's vertical component) is referred to as a "forward dynamics model" ; and the model used 
for calculating (outputting) the floor reaction force (in particular the desired ZMP or the floor reaction force moment 
about the desired ZMP and the floor reaction force's horizontal component) based on (by receiving) the desired foot 
position/posture, the desired body posture and the desired body position is referred to as an "inverse dynamics model". 
Inputs to the forward dynamics model include at least the desired floor reaction force, and inputs to the inverse dynamics 

15 model include at least the desired movement. 

[0201] The full model correction unit 100c has the inverse dynamics full model (often abbreviated as "inverse full 
model") or the forward dynamics full model (often abbreviated as "forward full model"). Typically, the forward dynamics 
model tends to require more calculation than the inverse dynamics model. 

[0202] Now, details of the processings performed by the gait generation device 1 00 according to a first embodiment 

20 of the present invention will be described more specifically. 

[0203] The gait generation device 100 according to this embodiment generates sequentially a desired gait for one 
step from the landing of one leg 2 of the robot 1 to the landing of the other leg 2, (desired gait according to the definition 
(b")). For example, in the case of generating the desired running gait shown in Figure 5, the desired gait is generated 
sequentially from the start of a one-leg supporting period to the end of the following floating period (that is, the start of 

25 the next one-leg supporting period). Here, the desired gait to be newly generated is referred to as a "current time gait", 
the next gait is referred to as a "next time gait", and the desired gait after next is referred to as a "next but one gait". 
In addition, the desired gait generated immediately before the current time gait is referred to as a "last time gait". 
[0204] When the gait generation device 100 newly generates a current time gait, the required values (requests) of 
the expected landing position/posture and expected landing time of the foot 22 of the free leg for the next two steps of 

30 the robot 1 are input to the gait generation device 1 00 as required gait parameters (or the gait generation device 100 
reads the required parameters from a storage device). Then, based on the required parameters, the gait generation 
device 1 00 generates the corrected desired body position/posture trajectory, the desired foot position/posture trajectory, 
the desired ZMP trajectory, the desired floor reaction force's vertical component trajectory, the desired arm posture 
trajectory, the corrected desired floor reaction force moment trajectory and the like. 

35 [0205] Now, taking the generation of the running gait shown in Figure 5 as an example, details of a gait generation 
process performed by the gait generation device 100 will be described with reference to Figures 13 to 39. Figure 13 
is a flowchart (structured flowchart) showing a gait generation process performed by the gait generation device 100. 
[0206] First, in step S010, various initialization operations, such as an operation of initializing the time t to 0, are 
conducted. This processing is conducted when activating the gait generation device 1 00, for example. Then ; the proc- 

40 ess proceeds to stop S01 4 through step S012, where the gait generation device 100 waits for a timer interruption for 
each control cycle (calculation process cycle of the flowchart in Figure 12). The control cycle is At. 
[0207] Then, the process proceeds to step S01 6, where it is determined whether a gait transition is detected or not. 
If a gait transition is detected, the process proceeds to step S018, or otherwise, the process proceeds to step S030. 
Here, the "gait transition" means a timing at which generation of the last time gait is completed and generation of the 

45 current time gait is started. For example, the transition from the control cycle having completed generation of the last 
time gait to the next control cycle is a gait transition. 

[0208] When the process proceeds to step S018, the time t is initialized to 0. Then, the process proceeds to step 
S020, where a next time gait's supporting leg coordinate system, a next but one time gait's supporting leg coordinate 
system, a current time gait's period and a next time gait's period are read in. These supporting leg coordinate systems 

50 and gait periods are determined by the required parameters described above. That is, in this embodiment, the required 
parameters given to the gait generation device 100 via the joystick 44 or the like include the required values of the 
expected landing positions/postures of the foot 22 of the free leg (position/posture of the foot 22 which is, once landing, 
rotated without slipping to come into contact with the floor at substantially the whole surface of the sole) and expected 
landing times for the next two steps. And, the required parameters are given to the gait generation device 100 before 

55 starting generation of the current time gait (before the gait transition detected in step S016) with the required values 
for the first step and the required values for the second step being associated with the current time gait and the next 
time gait, respectively. These required values can be changed in the process of generating the current time gait. 
[0209] The next time gait's supporting leg coordinate system is determined depending on the required value of the 
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expected landing position/posture of the foot 22 of the free leg for the first step (foot 22 of the free leg in the current 
time gait) included in the required parameters. 

[0210] For example, referring to Figure 16 ; the required value of the expected landing position/posture of the foot 
22 of the free leg in the current time gait (first step) (foot 22L in the drawing) is shifted in the X axis direction (back- 

5 and-forth direction of the foot 22R of the supporting leg in the current gait) and the Y axis direction (sideward direction 
of the fool 22R of the supporling leg in Lhe current gail) in the current time gait supporting leg coordinate system by 
xnext and ynexL respectively, and rotated by eznexl about the 2 axis with respect to the landing position/posture of 
the foot 22 of the supporting leg in the current time gait (foot 22R in the drawing). Here, the supporting leg coordinate 
system is a global coordinate system (coordinate system fixed to the floor) whose origin is set at a point where a 

10 perpendicular line, which is drawn from the center of the ankle of the supporting leg 2 to the floor surface in a state 
where the foot 22 of the supporting log is in a horizontal posture (more generally, parallel to the floor surface) and 
substantially the whole surface of the sole of the foot 22 of the supporting leg is in (intimate) contact with the floor 
surface, intersects with the floor surface and whose XY plane is the horizontal plane passing through the origin (in this 
embodiment, the point agrees with, the representative point of the foot 22 in the state where substantially the whole 

is surface of the sole of the foot 22 of the supporting leg is in contact with the floor surface). In this case, the X axis and 
Y axis directions are the back-and-forth and sideward directions of the foot 22 of the supporting leg, respectively. Here, 
the origin of the supporting leg coordinate system is not necessarily required to agree with the representative point of 
the foot 22 (point representative of the position of the foot 22) in the state where substantially the whole surface of the 
sole of the foot 22 of the supporting leg is in contact with the floor surface, and may be set at a point other than the 

20 representative point. 

[0211] Here, the next time gait's supporting leg coordinate system is a coordinate system whose origin is set at the 
representative point (or, more specifically, a point matched to the representative point on the floor) of the foot 22L of 
the free leg in the current time gait in the case where the foot 22L lands according to the required value of the expected 
landing position/posture of the foot 22L (where the representative point of the foot 22 agrees with the required value 

25 of the expected landing position and the posture (orientation) of the foot 22 agrees with the required value of the 
expected landing posture) as shown in the drawing, and whose X' axis and Y' axis directions are the back-and-forth 
and sideward directions of the foot 22L, respectively, in the horizontal plane passing through the origin. 
[021 2] Similarly, the next but one time gaits supporting leg coordinate system (see the X"Y" coordinate in Figure 1 5) 
is determined depending on the required value of the expected landing position/posture of the foot 22 of the free leg 

30 in the second step. The current time gait's period is a time period from the expected landing time (required value) of 
the foot 22 of the supporting leg in the current time gait to the expected landing time (required value) of the foot 22 of 
the free leg in the first step (current time gait). The next time gait's period is a time period from the expected landing 
time (required value) of the foot 22 of the free leg in the first step to the expected landing time (required value) of the 
foot 22 of the free leg in the second step. 

35 [0213] In this embodiment, the required parameters are input to the gait generation device 100 by operating the 
joystick 44 as required. Alternatively, the required parameters or the positions/postures and gait periods corresponding 
thereto may be previously stored as a movement schedule of the robot 1 . Alternatively, the next time gait's supporting 
leg coordinate, the next but one time gait's supporting leg coordinate, the current time gait's period and the next time 
gait's period may be determined based on an instruction (request) input via a manipulator, such as the joystick 44, and 

40 the movement history of the robot 1 up to that moment. 

[0214] Then, the process proceeds to step S022, where the gait generation device 100 determines gait parameters 
for a normal turning gait, which is a virtual cyclic gait following the current time gait. The gait parameters include a foot 
trajectory parameter for defining a desired foot position/posture trajectory in the normal turning gait, a reference body 
posture trajectory parameter for defining a reference body posture trajectory, and an arm trajectory parameter for 

45 defining a desired arm posture trajectory, a ZMP trajectory parameter for defining a desired ZMP trajectory and a floor 
reaction force's vertical component trajectory parameter for defining a desired floor reaction force's vertical component 
trajectory. Furthermore, the gait parameters include a parameter for defining a desired floor reaction force's horizontal 
component allowable range. 

[0215] The term "normal turning gait" in this specification is used to refer to a cyclic gait that, when repeated, results 
50 in no discontinuity in the movement states (states of the foot position/posture, body position/posture and the like) of 
the robot 1 at the boundaries between the gaits (boundaries between the successive gaits for different steps, in this 
embodiment). In the following, the "normal turning gait" is sometimes abbreviated as a "normal gait". 
[0216] In this embodiment, the normal turning gait is a cyclic gait comprising two steps of the robot 1 , and one cycle 
of the normal turning gait comprises a first turning gait following the current time gait and a second turning gait following 
55 the first turning gait. The word "turning" is used herein because "turning" can include "straight advance" in a broad 
sense since a turning ratio of 0 results in straight advance. Furthermore, if the desired gait to be generated is the 
running gait shown in Figure 5, the current time gait of the desired gait is a running gait having a one-leg supporting 
period and a floating period. Therefore, both of the first turning gait and second turning gait of the normal turning gait 
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are gaits having a one-leg supporting period and a floating period as with the current time gait. That is, the first and 
second turning gaits are basically the same as the current time gait. 

[0217] More specifically, one cycle of the normal turning gait of the two-legged mobile robot requires at least two 
steps of gait tn the narrow sense described above. A complicated normal turning gait having a cycle of three or more 

5 steps of gait can be set. However as described later, the normal turning gait is used exclusively to determine a diver- 
gence component (described in deLail later) at the end (end time) of the current lime gait. Therefore, using the normal 
turning gait comprising a cycle of three or more steps is not very effective in spite of the increasing complexity of the 
gait generating process. Thus, in this embodiment, one cycle of the normal turning gait is composed of two steps of 
gait (first and second turning gaits). For a legged mobile robot having three or more legs, the number of gaits required 

10 to define the normal turning gait increases accordingly. In the following, for the convenience of explanation, the normal 
turning gait comprising a plurality of gaits in the narrow sense (two, steps of gait in this embodiment) is regarded as 
one step of gait. 

[0218] The normal turning gait is a provisional gait created in the gait generation device 100 for determining move- 
ment states of the robot 1 including the divergence component at the end of the current time gait, the body' s vertical 
15 positional velocity, the body's posture angle and the angular velocity, and is not output directly from the gait generation 
device 100. 

[0219] Here, the word "divergence" means that the position of the body 24 of the two-legged mobile robot 1 is dis- 
placed far from the positions of the feet 22, 22, as shown in Figure 14. The value of the divergence component is a 
numerical value that represents the degree of displacement of the position of the body 24 of the two-ieggedmobile 

20 robot 1 from the positions of the feet 22, 22 (more specifically, the origin of the global coordinate system (supporting 
leg coordinate system) set on the surface with which the foot 22 of the supporting leg is in contact). 
[0220] In this embodiment, the desired gait is generated by using the divergence component as a reference index 
in order to allow the gait to be continuous without a divergence occurring in the gait. However, even an initial divergence 
component of a normal gait (a divergence component of a normal gait at the initial time thereof), which is a represent- 

25 ative example of continuous gaits, is not always simply 0 and varies with a parameter of the normal gait (the normal 
gait is a cyclic gait that has no discontinuity in the trajectory and can be repeated with the same pattern or, in theory, 
can be infinitely repeated without divergence even if repeated infinitely in theory). That is, the appropriate divergence 
component varies with the gait configuration, for example, the manner of walking or running. Thus, in this embodiment, 
the current time gait is generated, in such a manner that the normal gait to be generated following the current time gait 

30 is set in accordance with the required parameters of the current time gait, the initial divergence component of the 
normal gait is determined, and then the final divergence component of the current gait is made to agree with the initial 
divergence component of the normal gait (more generally, the current gait is made to be continuous with or close to 
the normal gait). The basic principle of such gait generation is the same as that described in Japanese Patent Appli- 
cation No. 2000-352011 previously proposed by the applicants. 

35 [0221] In the embodiments. of the present invention, the linear three-material-particle dynamics model used in the 
first embodiment describe in Japanese Patent Application No. 2000-352011 is not used. However, the concept of the 
divergence component and convergence component defined by the following formulas can be applied, in an approxi- 
mation manner with an adequate precision, to a perturbation of the behavior of the nonlinear dynamics model, such 
as the simplified model shown in Figure 11 . 
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divergence component = body material particle's horizontal 
position +- body material particle's horizontal velocity/o>0 formula c1 0 

convergence component = body material particle's horizontal 

position - body material particle's horizontal velocityAoO formula c1 1 



[0222] However, the body material particle's horizontal position is the body material particle's horizontal position Xb 
in the simplified model (dynamics model) shown in Figure 11. 

[0223] Furthermore, a>0 is a predetermined value, and the value during running has to be slightly varied from the 
value during walking gait generation described in Japanese Patent Application No. 2000-352011 . 
55 [0224] Other details concerning the divergence and convergence components are described in Japanese Patent 
Application No. 2000-352011 , and thus, further description thereof is omitted herein. 

[0225] In this embodiment, in addition to the method described in Japanese patent application no. 2000-352011 , as 
described later, a gait parameter that defines the desired floor reaction force's vertical component trajectory is set, and 
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the total center-of-gravity vertical position of the robot 1 is determined so as to satisfy, in terms of dynamics, the desired 
floor reaction force's vertical component. In this case, the second-order integral of the floor reaction force's vertical 
component defines the total center-of-gravity vertical position of the robot 1 . Therefore, if the desired floor reaction 
force's vertical component is set inadequately, the total center-of-gravity vertical position or body's vertical position of 
5 the robot t becomes too high or too low. Therefore, how to set the desired floor reaction force's vertical component is 
also an important problem. 

[0226] Returning to the main subject, in step S022. a process described below is conducted in accordance with Ihe 
flowchart shown in Figure 15. 

[0227] First, in step St 00, foot trajectory parameters of the gait parameters for the normal gait are determined in 

10 such a manner that the foot position/posture trajectories of the current time gait, the first turning gait and the second 
turning gait are connected to each other in this order. A specific setting manner will be described below with reference 
to Figure 16. In the following description, the foot 22 of the supporting leg 2 is referred to as a supporting leg's foot, 
and the foot 2 of the free leg 2 is referred to as a free leg's foot. Furthermore, the terms "initial (start)" and "final (end)" 
concerning the "gait" mean the start time and end time of the gait, respectively, or instantaneous gaits at the start time 

15 and end time of the gait, respectively. 

[0228] The foot trajectory parameters include supporting leg's foot positions/postures and free leg's foot positions/ 
postures at the start and end of the first turning gait and the second turning gait, and gait periods of the turning gaits. 
Of the foot trajectory parameters, the free leg's foot position/posture at the start of the first turning gait is regarded as 
the supporting leg's foot position/posture at the end of the current time gait seen from the next time's gait supporting 

20 leg coordinate system. In this case, in the running gait, the supporting leg's foot 22 at the end of the current time gait 
has floated in the air. The supporting leg's foot position/posture at the end of the current time is determined by using 
the finite duration settling filter to generate, until the end of the current gait, the foot position/posture trajectory (spe- 
cifically, trajectory seen from the next time gait's supporting leg coordinate system) that leads from the supporting leg's 
foot position/posture at the start of the current time gait (= the free leg's foot position/posture at the end of the last time 

25 gait) to the free leg's foot position/posture at the end of the next time gait that is determined depending on the required 
value of the expected landing position/posture of the free leg's foot 22 for the second step (required value of the 
expected landing position/posture in the next time gait of the supporting leg's foot 22 in the current time gait) of the 
required parameters or the next but one time gait's supporting leg coordinate system associated with the required value. 
[0229] Here, the free leg's foot position/posture at the end of the next time gait is determined in such a manner that 

30 the position/posture of the foot 22 rotated from the position/posture by a predetermined angle to the horizontal posture 
in the pitch direction by lowering the toe while keeping the foot 22 in contact with the floor agrees with the position/ 
posture thereof in the next but one time gait's supporting leg coordinate system. In other words, the free leg's foot 
position/posture at the end of the next time gait is the position/posture of the foot 22 that is rotated by a predetermined 
angie in the pitch direction by raising the toe while keeping the foot 22 in contact with the floor without slipping (a state 

35 where the foot 22 has the toe raised and the heel in contact with the floor) from the required value of the landing 
position/posture of the free leg's foot 22 in the second step of the required parameters. 

[0230] In addition, the supporting leg's foot position/posture at the start of the first turning gait is regarded as the free 
leg's foot position/posture at the end of the current time gait seen from the next time gait's supporting leg coordinate 
system. In this case, as with the free leg's foot position/posture at the end of the next time gait, the free ieg's foot 

40 position/posture at the end of the current time gait is determined depending on the next time gait's supporting leg 
coordinate system or the required value of the expected landing position/posture of the free leg for the first step (current 
time gait) of the required parameters associated with the next time gait's supporting leg coordinate system. That is, 
the free leg's foot position/posture at the end of the current time gait is determined in such a manner that the repre- 
sentative point of the foot 22 rotated from the position/posture by lowering the toe while keeping the foot 22 in contact 

45 W ith the floor to bring substantially the whole of the sole of the foot 22 into contact with the floor agrees with the origin 
of the next gait's supporting leg coordinate system. 

[0231] As with the free leg's foot position/posture at the end of the current time gait and the free leg's foot position/ 
posture at the end of the next time gait, the free leg's position/posture at the end of the first turning gait is determined 
based on the position/posture in the next but one time gait's supporting leg coordinate system seen from the next time 

so gait's supporting leg coordinate system. More specifically, the free leg's foot position/posture at the end of the first 
turning gait is set in such a manner that the position/posture of the foot 22 that is rotated from the position/posture by 
a predetermined angle to the horizontal posture while keeping the foot 22 in contact with the floor without slipping 
agrees with the position/posture in the next but one time gait' s supporting leg coordinate system seen from the next 
time gait's supporting leg coordinate system. 

55 [0232] At the end of the first turning gait, the supporting leg' s foot 22 is away from the floor and floats in the air. To 
determine the trajectory after the supporting leg's foot 22 takes off the floor, an expected landing position/posture of 
the first turning gait's supporting leg's foot is set. The expected landing position/posture of the first turning gait's sup- 
porting leg's foot is set based on the position/posture in a next but two gait's supporting leg coordinate system seen 



31 



BNSDOCID: <EP .1473122A1 I > 



EP 1 473 122 A1 



from the next time gait's supporting leg coordinate system. More specifically, the expected landing position/posture of 
the first turning gait's supporting leg's foot is the position/posture in the next but two gait's supporting leg coordinate 
system seen from the next time gait's supporting leg coordinate system. Here, the next but two gait's supporting leg 
coordinate system is set in such a manner that the relative position/posture relationship between the next but one time 
5 gait's supporting leg coordinate system and the next but two gait's supporting leg coordinate system agrees with the 
relative position/posture relationship between the current lime gail's supporting leg coordinate system and the nexl 
time gait's supporting leg coordinate system. 

[0233] As with the supporting leg's foot position/posture at the start of the first turning gait, the supporting leg's foot 
position/posture at the end of the first turning gait is determined by using the finite duration settling filter to generate 

10 the foot position/posture trajectory leading from the supporting leg's foot position/posture at the start of the first turning 
gait to tho expected landing position/posture of the first turning gait's supporting leg's foot (more specifically, trajectory 
seen from the next time gait's supporting leg coordinate system) until the end of the first turning gait. 
[0234] The free leg's foot position/posture at the start of the second turning gait is the supporting leg's foot position/ 
posture at the end of the first turning gait seen from the next but one time gait's supporting leg coordinate system. The 

15 supporting leg's foot position/posture at the start of the second turning gait is the free leg's foot position/posture at the 
end of the first turning gait seen from the next but one time gait's supporting leg coordinate system. 
[0235] The free leg's foot position/posture at the end of the second turning gait is the free leg's foot position/posture 
at the end of the current time gait seen from the current time gait's supporting leg coordinate system. The supporting 
leg's foot position/posture at the end of the second turning gait is the supporting leg's foot position/posture at the end 

20 of the current time gait seen from the current time gait's supporting leg coordinate system. 

[0236] The gait periods of the first and second turning gaits are set to be the same as the period of the next time 
gait. The gait periods of the first and second turning gaits are not necessarily required to be the same. However, both 
the periods are preferably determined in accordance with the period of the next time gait. Movement parameters of 
the current time gait, the first turning gait and the second turning gait other than those described above (including time 

25 parameters including the two leg supporting period duration) are appropriately determined so as to satisfy the gait 
requirements (for example, that the velocity of an actuator falls within an allowable range, that an allowable angle of 
the actuator is not surpassed and that a foot is not in contact with the floor or the like) in accordance with the parameters 
determined as described above. 

[0237] Then, the process proceeds to step S102, where the reference body position/posture trajectory parameter 
30 for defining the reference body position/posture trajectory to be followed by the desired body posture is determined. 
The reference body posture is not necessarily required to be constant, as far as the reference body posture is the same 
at the start of the normal gait (start of the first turning gait) and the end thereof (end of the second turning gait) (the 
posture angle of the reference body posture and the angular velocity thereof are the same at the start and the end of 
the normal gait). However, in this embodiment, to be readily understood, the reference body posture is the upright 
35 posture (vertical posture). That is, in this embodiment, the reference body posture is the upright posture throughout 
the duration of the normal gait. Therefore, in this embodiment, the angular velocity and angular acceleration of the 
posture angle of the reference body posture are 0. 

[0238] Then, the process proceeds to step S104, where arm posture trajectory parameters, more specifically, the 
arm posture trajectory parameters other than those concerning the angular momentums of the arms about the vertical 
40 axis (or body trunk axis) are determined. For example, arm posture trajectory parameters, such as the relative height 
of the tip of the arm with respect to the body 24 or the relative position of the center of gravity of the entire arm with 
respect to the body 24, are determined. In this embodiment, the relative position of the center of gravity of the entire 
arm is kept constant with respect to the body 

[0239] Then, the process proceeds to step S1 06, where floor reaction force's vertical component trajectory param- 
45 eters are set. In this case, the floor reaction force's vertical component trajectory parameters are set in such a manner 
that the floor reaction force's vertical component trajectory defined by the parameters is substantially continuous (i.e., 
has no step-wise discrete values) in the first and second turning gaits as shown in Figure 6. That is, the desired floor 
reaction force's vertical component trajectory of the normal turning gait is set to be the pattern shown in Figure 17. 
According to this pattern, both for the first and second turning gaits, the floor reaction force's vertical component varies 
in a trapezoidal shape during the one leg supporting period and is kept at 0 during the floating period. And, the times 
of the apexes of the pattern and the heights (peak values) of the trapezoids are set as the floor reaction force's vertical 
component trajectory parameters. 

[0240] In setting the floor reaction force's vertical component trajectory parameters, the average value of the floor 
reaction force's vertical component for the whole gait duration (period of one cycle of the normal gait, which is a sum 
of the periods of the first and second turning gaits) is made to agree with the weight of the robot 1 . That is, the average 
value of the floor reaction force's vertical component is made equal in magnitude and opposite in direction to gravity 
applied to the robot 1. 

[0241] Setting the floor reaction force's vertical component traj ectory as described above is required to satisfy the 
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normal gait requirement. The normal gait requirement is that the initial states of all the state variables (positions., pos- 
tures and velocities of the parts of the robot 1 ) of the gait seen from the supporting leg coordinate system (coordinate 
system set on the surface at which the supporting leg's foot 22 is in contact) agree with the final states of the gait (final 
states of the second turning gait) seen from the next supporting leg coordinate system (supporting leg coordinate 

5 system of the next first turning gait) (hereinafter, this requirement is sometimes referred to as a boundary requirement 
of the normal gait). Therefore, the difference between the total center-of-gravity vertical velocity of the robot 1 at the 
end of the normal gait and the total center-of-gravity vertical velocity at the start of the normal gait (more specifically, 
difference between the total center-of-gravity vertical velocity at the end of the second turning gait and the total center- 
of-gravity vertical velocity at the start of the first turning gait) has to be 0. Since the difference described above is an 

10 integral (first order integral) of the difference between the floor reaction force's vertical component and gravity, the floor 
reaction force's vertical component trajectory has to be set as described above in order for the difference to be 0. 
[0242] In this embodiment, the average values of the floor reaction force's vertical component for the periods of the 
first and second turning gaits are made to agree with the weight of the robot 1 . More specifically, for example, after the 
times of the apexes of the trapezoidal line of the floor reaction force's vertical component trajectory in the first and 

15 second turning gaits are determined in accordance with the periods of the gaits, the heights of the trapezoids are 
determined in such a manner that the average values of the floor reaction force's vertical component for the first and 
second turning gaits agree with the weight of the robot 1 (the height of the trapezoids is determined by solving an 
equation representing agreement between the average values and the weight with the height of the trapezoid being 
assumed to be an unknown quantity). 

20 [0243] This results in a difference of 0 between the total center-of-gravity vertical velocity at the end of the first turning 
gait and the total center-of-gravity vertical velocity at the start of the first turning gait and a difference of 0 between the 
total center-of-gravity vertical component at the end of the second turning gait and the total center-of-gravity vertical 
velocity at the start of the second turning gait. However, this is not essential. Alternatively, for example, the body's 
vertical position becomes too high or too low and, thus, the robot takes an unreasonable posture in the vicinity of the 

25 boundary between the first and second turning gaits, the height of the trapezoid of the floor reaction force's vertical 
component trajectory for the turning gaits may be modified from the state where the average values for the turning 
gaits agree with the weight. 

[0244] Then, the process proceeds to step S108, where an allowable range [Fxmin, Fxmax] (more specifically, a 
parameter that defines the allowable range) of the floor reaction force's horizontal component for the simplified model 

30 gait (more specifically, for the normal gait of the simplified model gait) is determined, as shown in Figure 18, in accord- 
ance with the floor reaction force's vertical component trajectory determined as described above as shown in Figure 
17. The polygonal line on the negative side in Figure 18 represents the floor reaction force's horizontal component's 
allowable lower limit value Fxmin, and the polygonal line on the positive side represents the floor reaction force's 
horizontal component's allowable upper limit value Fxmax. The following is a supplementary description of a method 

35 of setting these values. In the following, a case where the floor surface is horizontal will be described. 

[0245] The floor reaction force's horizontal component occurs due to friction between the floor and the foot 22. How- 
ever, friction cannot be produced infinitely. Therefore, in order to prevent the actual robot 1 from slipping when it moves 
in accordance with the desired gait generated, the floor reaction force's horizontal component of the desired gait has 
to always fall within the friction limit. Thus, in order to satisfy this requirement, the floor reaction force's horizontal 

40 component allowable range is set, and, as described later, the desired gait is generated in such a manner that the floor 
reaction force' s horizontal component of the desired gait falls within the allowable range. 

[0246] Assuming that the friction coefficient between the floor and the foot 22 is u,, the value of Fxmin has to be 
always equal to or higher than - \x * (floor reaction force's vertical component), and the value of Fxmax has to be always 
equal to or lower than \x * (floor reaction force's vertical component) The simplest settings are as follows. Herein, ka 
45 is a positive constant smaller than 1 . 

Fxmin = -ka * u. * (floor reaction force's vertical component) 
50 Fxmax = ka * p. * (floor reaction force's vertical component) formula c12 

[0247] The floor reaction force's horizontal component allowable range shown in Figure 18 is an exemplary range 
set in accordance with the formula c12. As parameters for defining the floor reaction force's horizontal component 
allowable range ; the times of the apexes of trapezoidal waveform and the values of the waveform at the times in Figure 
55 18 may be set. However, in the case where the floor reaction force's horizontal component allowable range is deter- 
mined by the formula d 2, the parameter to be set may be only the value of (ka * u.) in the formula c1 2. 
[0248] As far as the requirement (that the floor reaction force's horizontal component of the desired gait always falls 
within the friction limit) is satisfied, the floor reaction force's horizontal component allowable range may be set in any 
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other setting method. Since the floor reaction force's horizontal component allowable range for the simplified model 
gait is used to generate a provisional gait (simplified model gait), it is not necessarily required to determine the range 
based on a strict friction limit, and the floor reaction force's horizontal component allowable range for the one leg 
supporting period may be set to exceed the friction limit, for example. The same holds true for the floating period. 

5 [0249] Then, the process proceeds to step S110, where aZMP trajectory parameter that define the ZMP trajectory 
for the normal gait, which is a sum of the first and second turning gaits, is determined. In this case, the desired ZMP 
trajectory is determined to have a high stability margin and not to change abruptly, as described above. 
[0250] More specifically, in the running gait shown in Figure 5, the heel of the supporting leg's foot 22 first lands, and 
some time after that, substantially the whole surface of the sole of the supporting leg's foot 22 comes into contact with 

10 the floor. Then, only the toe of the supporting leg's foot 22 comes into contact with the floor. Then, the robot jumps into 
the air by kicking the floor on the toe of the supporting leg's foot 22, and finally, the heel of the free leg's foot 22 lands. 
Besides, the desired ZMP has to lie within the contact surface. Thus, in this embodiment, as shown in the upper part 
of Figure 7, both for the first and second turning gaits of the normal gait, the x-axis directional position of the desired 
ZMP is set to remain at the initial position, which is the position of the heel of the supporting leg's foot 22, until sub- 

15 stantially the whole surface of the sole of the foot 22 comes into contact with the floor. Then, the desired ZMP is shifted 
to the middle of the supporting leg's foot 22 and then to the toe, making the foot 22 in contact with the floor only at the 
toe. Then, the desired ZMP remains at the position of the toe of the supporting leg's foot 22 until the foot takes off the 
floor, After that, as described above, the desired ZMP is shifted continuously from the toe of the supporting leg's foot 
22 to the landing position of the heel of the free leg's foot 22 by the time of the next landing of the free leg's foot 22. 

20 Thus, the desired ZMP trajectory (X-axis directional traj ectory) for the normal gait comprising the first and second 
turning gaits is as shown in Figure 1 9. The times and positions of the apexes of the desired ZMP trajectory are set as 
ZMP trajectory parameters. In this case, the times of the apexes of the trajectory are determined based on the gait 
periods of the first and second turning gaits determined based on the required parameters, and the positions of the 
apexes of the trajectory are determined based on the positions/postures in the next time gait's supporting leg coordinate 

25 system and the next but one time gait's supporting leg coordinate system, or based on the required values of the 
expected landing positions/postures of the free leg's foot for the first and second steps of the required parameters that 
define these coordinate systems. The Y-axis directional position of the ZMP trajectory is determined as shown in the 
lower part of Figure 7. More specifically, the trajectory of the Y-axis directional position of the desired ZMP for the first 
turning gait is set in the same pattern as that shown in the lower part of Figure 7, and the trajectory of the Y-axis 

30 directional position of the desired ZMP for the second turning gait is set to have the same shape as that for the first 
turning gait and to be connected to the end of the trajectory for the first turning gait. 

[0251] Finally the process proceeds to step S112, where the initial time, the end time and the period of one step 
(one cycle) of the normal gait are redefined as follows. 

[0252] The normal gait has to be a gait having state variables that are continuous at the start and the end thereof. 

35 For convenience of determination of such a gait, in this embodiment, until the normal gait is determined, unlike the 
definition of the gait in the narrow sense, the initial time, the end time and the period of one step of the normal gait are 
defined as shown in Figure 17. That is, the time at which the floor reaction force' s vertical component is decreased to 
some degree in the latter half of the one leg supporting period of the first turning gait is set as the initial time Ts of the 
normal gait. As shown in Figure 7, the initial time Ts is preferably set to the instant when the supporting leg's foot 22 

40 having been in contact with the floor at substantially the whole surface of the sole thereof comes into contact with the 
floor only at the toe thereof or a time immediately before the instant (the end time of the period in which whole the sole 
of the foot is in contact with the floor or a time immediately before the end time in Figure 7). In addition, as for the 
relationship between the desired ZMP and the time Ts determined in step S110 and shown in Figure 19 (or Figure 7), 
it is preferable that the time Ts is the instant when the supporting leg' s foot is in contact with the floor only at the toe 

45 after the desired ZMP has been completely shifted to the toe of the supporting leg's foot 22 through the middle thereof 
after substantially the whole surface of the sole of the supporting leg's foot 22 had come into contact with the floor in 
the first turning gait. Such an initial time Ts is determined in accordance with the desired ZMP trajectory parameter 
previously determined, for example. The reason why the initial time Ts is determined as described above will be de- 
scribed later. 

50 [0253] Furthermore, as shown in Figure 1 7, the period Tcyc of the normal gait is a sum of the gait periods of the first 
and second turning gaits. The end time of the normal gait is Te. Te is the time Ts plus Tcyc. 

[0254] From the point in time when the normal gait is determined (when the loop of step S204 in Figure 20 described 
later exits), the definitions of the initial time, the end time and the like of the gait in the narrow sense described above 
are adopted again. In the following description, the initial time according to the definition of the gait in the narrow sense 
55 described above (the time of the landing of the supporting leg's foot 22) is assumed to be 0, and reference symbol Ts 
is used to discriminate this original initial time 0 from the above-described initial time Ts used until the normal gait is 
determined (sometimes simply abbreviated as "Ts"). 

[0255] After the processings from steps S010 to S022 in Figure 13 is conducted, the process proceeds to step S204, 
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where initial states of the normal gait are calculated. The initial states calculated in this step include the initial body 
horizontal position/velocity (initial body position and initial body velocity in the horizontal direction), theinitial body ver- 
tical position/velocity (initial body vertical position and initial body velocity in the vertical direction) , the initial divergence 
component, the initial body posture angle and the angular velocity thereof for the normal gait. These initial states are 

5 calculated in a searching manner according to the flowchart in Figure 20. 

[0256] In the flowchart in Figure 20, first, in step S200, the inilial states (slates al the initial time Ts) of the desired 
fool position/posture, the desired arm posture and the desired body posture angle (posture angle and direction) are 
determined based on the gait parameters for the normal gait (parameters determined in step S022 in Figure 13). The 
term "state" refers to a position, a posture angle and variation rates (time differentials) thereof. 

10 [0257] In this case, the initial state of the desired foot position/posture of the supporting leg is determined by using 
the finite duration settling filter to generate the foot position/posture trajectory (trajectory seen from the next time gait's 
supporting leg coordinate system) leading from the supporting leg's foot position/posture at the start of the first turning 
gait of the foot trajectory parameters determined in step S100 in Figure 15 to the free leg's foot position/posture at the 
end of the second turning gait until the time Ts. The initial state of the desired foot position/posture for the free leg is 

15 determined by using the finite duration settling filter to generate the foot position/posture trajectory leading fromthe 
supporting leg's foot position/posture at the start of the current time gait seen from the next time gait's supporting leg 
coordinate system to the free leg's foot position/posture at the end of the first turning gait until the time Ts. Besides, 
the initial state of the desired arm posture is determined by determining the arm posture (total center- of -gravity position 
of the arms with respect to the body 24, for example) at the time Ts based on the arm posture trajectory parameters 

20 determined in step S104 in Figure 15. Besides, as the initial state of the desired body posture angle, the reference 
body posture (posture angle) and the angular velocity thereof at the time Ts, which are determined based on the 
reference body posture trajectory parameters determined in step S102 in Figure 15, are determined. In this embodi- 
ment, since the reference state posture angie is the vertical posture, the initial state of the desired body posture angle 
is 0 (the posture angle and the angular velocity thereof are 0). Furthermore, in this embodiment, the desired foot 

25 position/posture trajectory, the floor reaction force's vertical component trajectory and the desired ZMP trajectory for 
the normal gait are independently determined from the foot trajectory parameters, the floor reaction force's vertical 
component trajectory parameters and the ZMP trajectory parameters determined in the flowchart in Figure 1 5, respec- 
tively. For example, the instantaneous desired foot position/posture for the normal gait is determined based on the foot 
trajectory parameters, independently of the instantaneous value of the floor reaction force's vertical component. 

30 [0258] Then, in step S202, (Xs, Vxs), which are candidates for the initial body horizontal position/velocity (that is, 
body horizontal position/posture candidates at the initial time Ts) , are provisionally determined, where Xs is the hori- 
zontal position and Vxs is the horizontal velocity. The candidates (Xs, Vxs) provisionally determined in this step may 
be arbitrary ones and, for example, may be the body horizontal position/velocity of the initial states of the normal gait 
determined when the last time gait is generated. 

35 [0259] For the simplicity of explanation, a case where the initial states for the normal gait in the X direction (back 
and forth direction) in the sagittal plane are searched for is taken as an example. Actually, however, both for the position 
and velocity, the initial states for the normal gait (initial states that satisfy the boundary requirement of the normal gait) 
for the X direction (back and forth direction) and the Y direction (sideward direction) have to be searched for separately 
or concurrently. 

[0260] As the determination method in a searching manner, the simplex method or a method of determining an affine 
Jacobian (sensitivity matrix) and determining a next candidate by the steepest descent method may be used, in this 
embodiment, the steepest descent method is used. 

[0261 ] Then , in step S206 after step S204, the initial (time Ts) body vertical position/velocity (Zs, Vzs) is determined, 
where Zs is the vertical position and Vzs is the vertical velocity. 

[0262] In this embodiment, the initial body vertical velocity Vzs is determined as follows in an analytical manner. 
[0263] For the robot 1 , the following dynamical relationship holds. 
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(final total center-of-gravity vertical position) - (initial 
total center-of-gravity vertical position) 
= second order integral of (floor reaction force's vertical 
55 component/total mass of tho robot) 

+ second order integral of the gravitational acceleration 
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4- (initial total center- of- gravity vertical velocity) * 

(duration of one step) formula c13 

5 

(The gravitational acceleration is a negative value.) 

[0264] In the normal gait since the final total center-of-gravity vertical position agrees with the initial total center-of- 
gravity vertical position, the right side in the formula c13 has to be 0. Thus ; the initial total center-of-gravity vertical 

10 velocity can be determined from these relationships. Specifically, a value obtained by dividing the floor reaction force's 
vertical component, which is calculated from the floor reaction force's vertical component parameters set in step S104 
in Figure 15, by the total mass of the robot 1 is integrated two times with respect to the period of one step (from the 
time Ts to the time Te) , thereby determining the displacement of the total center of gravity due to the floor reaction 
force's vertical component (first term in the right side of the formula c13). Furthermore, the gravitational acceleration 

15 is integrated two times with respect to the period of one step, thereby determining the displacement of the total center 
of gravity due to gravity (second term in the right side of the formula c13) Then, the sum of the displacement of the 
total center of gravity due to the floor reaction force and the displacement of the total center of gravity due to gravity 
is inverted in sign, and the resulting value is divided by the duration of one step (duration of one cycle Tcycl of the 
normal gait), thereby determining the initial total center-of-gravity vertical velocity. 

20 [0265] Then, in order to determine the initial body vertical position Zs, the total center-of-gravity vertical velocity at 
the time 0 is determined using the following formula. In this process,, the value determined from the formula c13 as 
described above is substituted for the total center-of-gravity vertical velocity at the time Ts in the following formula, and 
the integral time is from the time 0 to the time Ts. 

25 

(total center-of-gravity vertical velocity at the time Ts) 
- (total center-of-gravity vertical velocity at the time 0) 
30 = first order integral of (floor reaction force's vertical 

component/total mass of the robot) 
+ first order integral of the gravitational acceleration formula c14 

35 

(The gravitational acceleration is a negative value.)) 



[0266] Then, the body height determination method proposed in Japanese Patent Laid-Open No. 10-86080 by the 
applicants is used to determine the body height (body vertical position) at the time 0 (that is, at the instant of landing). 
In this process, the body vertical position (body height) that allows the knees of the legs 2, 2 not to be fully stretched 
at the time 0 is determined based on the foot position/posture at the time 0 (the supporting leg's foot position/posture 
at the start of the first turning gait (at the time 0) and the free leg's foot position/posture at the start of the first turning 
gait (at the time 0) determined in step S100 in Figure 15) and a predetermined geometrical condition concerning the 
bending angle of the knees of the legs 2. Specifically, assuming that the bending angle of the knee of the supporting 
leg 2 is Gsup and the bending angle the knee of the free leg 2 is 9swg. the body vertical position is determined in such 
a manner that the sum of the inverse numbers of the sinusoidal values of the knee bending angles Osup and Oswg 
equals to a predetermined value (finite value), for example. Here, the knee bending angles Gsup and eswg are the 
angles of the center axis of the crus part with respect to the center axis of the thigh part of each leg 2 and increase 
from 0 as the knee is bent from a state where each leg 2 is fully stretched. Such a method of determining the vertical 
position of the body 24 is described in detail in Japanese Patent Laid-Open No. 1 0-86080, and thus, further description 
thereof is omitted herein. 

[0267] Then, from the body vertical position and the foot position/posture at the time 0 thus determined, the total 
center-of-gravityvertical position at the time 0 is determined using the simplified model. For example, the kinematics 
model represented by the formula b11 , which corresponds to the simplified model shown in Figure 11, may be used 
to determine the total center-of-gravity vertical position at the time 0. Specifically, the vertical position of the body 
material particle 24m is determined from the body vertical position and the body posture angle (0 in this embodiment) 
at the time 0, and the vertical positions of the supporting leg material particle 2m and the free leg material particle 2m 
are determined from the supporting leg's foot position/posture and the free leg's foot position/posture at the time 0 (the 
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supporting leg's foot position/posture at the start of the first turning gait and the free leg's foot position/posture at the 
start of the first turning gait determined in step S100 in Figure 15), respectively. Then, these vertical positions of the 
body material particle 24m, the supporting leg material particle 2m and the free leg material particle 2m are substituted 
for Zb, Zsup and Zswg in the formula bit, respectively, thereby determining the total center-of -gravity vertical position 
5 (ZGtotal in the formula b11). Alternatively, a more precise model of the robot 1 (for example, the full model (multi-mass 
model) such as shown in Figure 12) may be used Lo lake into consideration the body horizontal position and the arm 
posture at the lime 0 to determine the total cenler-or-gravity vertical position at the time 0. 

[0268] Then, in the formula c13, the total center-of-gravity vertical position at the time 0 determined as described 
above is substituted for the initial total center-of-gravity vertical position in the left side of the formula c13 ; the total 

10 center-of-gravity vertical velocity at the time 0 determined as described above is substituted for the initial total center- 
of-gravity vertical velocity in the right side of the formula c1 3, Ts is substituted for the duration of one step in the formula 
c13. and a period from the time 0 to the time Ts is defined as the integral period, thereby calculating the value of the 
final total center-of-gravity vertical position in the left side of the formula c13, which is regarded as the initial (time Ts) 
total center-of-gravity vertical position. Furthermore, from the initial (time Ts) total center-of-gravity vertical position, 

15 the foot position/posture at the time Ts (determined in step S200) and the like, the initial (time Ts) body vertical position 
Zs is determined using a model of the robot 1 (the kinematics model represented by the formula 04, for example). 
Specifically, from the horizontal positions/postures of the supporting leg and the free leg at the time Ts, the vertical 
positions of the supporting leg material particle 2m and the free leg material particle 2m in the model shown in Figure 
11 are determined, and the vertical positions and the initial (time Ts) total center-of-gravity position determined as 

20 described above are applied to the formula b1 1 , thereby determining the vertical position of the body material particle 
24m (Zb in the formula b11). Then, from the vertical position of the body material particle 24m and the body posture 
at the time Ts (0 in this embodiment), the initial (time Ts) body vertical position Zs can be determined in an inverse 
operation manner. In this case also, a more precise model (for example, the full model shown in Figure 12) may be 
used to take into consideration the body horizontal position and the arm posture to determine the initial body vertical 

25 position Zs. 

[0269] Finally, from the initial state of the foot position/posture determined in step S200, the initial total center-of- 
gravity vertical velocity determined in step S206 and the like, the initial body vertical velocity is determined using a 
model of the robot 1 (for example, the kinematics model represented by the formula b11). Specifically, the initial total 
center-of-gravity vertical velocity determined based on the formula c13 and the vertical velocities of the supporting leg 

30 material particle 2m and the free leg material particle 2m determined by the initial states of the foot positions/postures 
of the supporting leg and free leg are applied to a formula obtained by time-differentiating the both sides of the formula 
b11 , thereby determining the vertical velocity of the body material particle 22m. Then, from the vertical velocity of the 
body material particle 22m and the initial state of the body posture angle (determined in step S200 or S208 described 
later), the body vertical velocity is determined. Alternatively, such an initial body vertical velocity that provides the initial 

35 total center-of-gravity vertical velocity determined as described above may be determined using a more precise model 
of the robot 1 by taking into consideration the initial state of the arm posture (determined in step S200), the initial state 
of the body horizontal position provisionally determined (the latest ones provisionally determined in step S202 or step 
S216 or S218 described later) and the initial body vertical position determined as described above in addition to the 
initial state of the foot position/posture and the initial total center-of-gravity vertical velocity. 

40 [0270] More specifically, even if the model of the robot 1 is a complicated (precise) one such as shown in Figure 1 2, 
since the robot 1 has six degrees of freedom for each leg, all the initial states of the robot are determined uniquely if 
the initial states of the foot position/posture trajectory and the body position/posture trajectory (position/posture and 
the variation rates thereof) are given. Therefore, the initial total center-of-gravity vertical velocity can be determined 
uniquely if the same are given. Inversely, since the robot has six degrees of freedom for each leg, even if one, concerning 

^5 velocity, of the initial states of the foot position/posture trajectory and the body position/posture trajectory (for example, 
the initial body vertical velocity) is undetermined, the undetermined initial state is determined uniquely if the initial total 
center-of-gravity vertical velocity is given. 

[0271] After the processing of step S206, the process proceeds to step S208, where a provisional normal turning 
gait is generated. More specifically, based on the gait parameters of the normal gait determined in step S022 in Figure 

50 13, the desired ZMP, the desired floor reaction force's vertical component, the desired foot position/posture, the refer- 
ence body posture, the desired arm posture and the floor reaction force's horizontal component allowable range at 
instants between the initial time Ts and the end time Te are determined successively. Then, in such a manner that the 
dynamical equilibrium conditions concerning the desired ZMP and the desired floor reaction force's vertical component 
and the condition concerning the floor reaction force's horizontal component allowable range are satisfied, the body 

55 position/posture is determined using the simplified model (dynamics model) shown in Figure 1 1 assuming that the body 
horizontal position/velocity (Xs, Vxs) and the body vertical position/velocity (Zs, Vzs) are the initial (time Ts) states of 
the body 24, thereby generating the gait from the time Ts to the end time Te (provisional gait for the normal gait). In 
this process, the body posture is generated so as to agree with the reference body posture as closely as possible 
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[0272] The generation of the normal gait is performed only in the gait generation device 100 ; and the result is not 
output to the composite-compliance determinator 1 04, described later as a desired value for driving the actual robot 1 . 
[0273] Details of a normal gait generation process using successive calculation, which is the processing in step 
S208 ; will be described below. 

5 [0274] Figure 21 is a subroutine flowchart showing the process. 

[0275] In slep S300, various initialisations are performed. Specifically, the initial time Ts is substituted for the provi- 
sional gait generation time k. Furthermore, the currently determined provisional values (Xs, Vxs) (determined in step 
S202 in Figure 20 or steps S216 or S218 described later) are substituted for the body horizontal position/velocity, and 
the latest values (Zs, Vzs) determined in step S206 are substituted for the body vertical position/velocity. In addition, 

10 the reference body posture angle's initial value (reference body posture angle at the time Ts) is substituted for the 
desired body posture angle, and the reference body posture angular velocity's initial value (reference body posture 
angu lar velocity at the time Ts) is substituted for the desired body posture angular velocity. In addition, the initial desired 
body posture angular velocity is eventually changed as described later, and therefore, a value different from the refer- 
ence body posture angular velocity's initial value may be substituted for the desired body posture angular velocity. 

15 [0276] Then, in step S304 after step S302, it is determined whether the provisional gait generation time k proceeds 
the end time of the gait or not (whether k < Ts + Tcyc). if the result of the determination is YES, the process proceeds 
to a gait instantaneous value determination subroutine of step S306, where gait instantaneous values are determined. 
Then, the process of the gait generation device 1 00 proceeds to step S308. where the provisional gait generation time 
k is incremented by Ak. and then, the process returns to step S304. 

20 [0277] Here, Ak is an interval between provisional gait generations and may generally be the same as the control 
cycle At. If the dynamical precision of the provisional gait can be lowered, Ak may be set longer than At for reducing 
the calculation amount. 

[0278] If the result of the determination in step S304 is NO, the process proceeds to step S310. By the process 
described above, the normal gait is generated from the start to the end thereof before the process proceeds to step 
25 S310. 

[0279] Details of the gait instantaneous value determination subroutine of step S306 will be described with reference 
to Figure 22. 

[0280] First, in step S400 in Figure 22, based on the normal gait parameters (floor reaction force's vertical component 
trajectory parameters) , the value (current time value) of the desired floor reaction force's vertical component at the 
30 time k shown in Figure 17 is determined Furthermore, in step S402, based on the normal gait parameters (ZMP traj 
ectory parameters), the value (current time value) of the desired ZMP trajectory at the time k shown in Figure 19 is 
determined. 

[0281] Then, the process proceeds to step S404, where based on the normal gait parameters (the foot trajectory 
parameters, the reference body posture trajectory parameters and the arm posture trajectory parameters), the values 

35 (current time values) of the desired feet positions/postures (desired foot positions/postures of the supporting leg and 
the free leg), the reference body posture and the desired arm posture at the time k are determined. More specifically, 
as for the desired arm posture, the total center-of-gravity position of the both arms is determined, although the move- 
ment (swing movement) of the arm involving a change of angular momentum about the vertical axis (or body trunk 
axis) is not determined yet. The current time vai ue (value at the time k) of the desired foot position/posture is determined 

40 in the same manner as the foot position/posture at the initial time Ts determined in step S200 in Figure 20. 

[0282] Then, the process proceeds to step S406, where the value (current time value) of the total center-of-gravity 
vertical position/velocity at the time k that provides the desired floor reaction force's vertical component (i.e., brings 
the sum of the vertical inertial force of the robot 1 and the gravity into balance with the desired floor reaction force's 
vertical component) is calculated. Specifically, based on the formulas a8 and b11 concerning the simplified model in 

45 Figure 11 , the total center-of-gravity vertical position/velocity is calculated That is, according to the formulas a8 and 
b1 1 . there is provided a formula (equation of motion concerning the total center of gravity of the robot 1 in the vertical 
direction) that represents that the total mass of the robot 1 multiplied by the sum of the total center-of-gravity vertical 
acceleration due to the movement of the robot 1 and the gravitational acceleration equals to the floor reaction force's 
vertical component. Thus, from the formula and the desired floor reaction force's vertical component, the total center- 

50 of-gravity vertical acceleration is determined. 

[0283] This formula itself generally holds without depending on the model of the robot 1. Then, the total vertical 
acceleration thus determined is integrated, thereby calculating the total center-of-gravity vertical velocity, and the total 
center-of-gravity vertical velocity is further integrated, thereby calculating the total center-of-gravity vertical position. 
More generally, these calculations are performed using the dynamical formulas represented by the following formulas 

55 c1 5 and d 6 (discrete versions of the Newton's equation of motion). 

total center-of-gravity vertical velocity at the time k 
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- total center-of-gravity vertical velocity at the time (k-Ak) 
+ ( (floor reaction force's vertical component/total mass of 

5 

the robot) + gravitational acceleration) * Ak 
(The gravitational acceleration is a negative value.) formula c1 5 

10 

total center-of-gravity vertical position at the time k 
= total center-of-gravity vertical position at the time (k-Ak) 
15 + total center-of-gravity vertical velocity at the time k * 

Ak formula c1 6 

[0284] Then, the process proceeds to step S408, where the body vertical position that provides the total center-of- 

20 gravity vertical position is calculated. Specifically, using the formula b11 concerning the simplified model in Figure 11 , 
the total center-of-gravity vertical position is calculated. That is, from the current values of the desired foot positions/ 
postures of the supporting leg and the free leg, the vertical positions of the supporting leg material particle 2m and the 
free leg material particle 2m in the simplified model in Figure 11 are determined. Then, these vertical positions of the 
supporting leg material particle 2m and the free leg material particle 2m and the current value of the total center-of- 

25 gravity vertical position determined in step S407 are applied to the formula b11 , thereby determining the vertical position 
of the body material particle 24m. Furthermore, the body vertical position is determined from the vertical position of 
the body material particle 24m and the current value of the desired body posture angle (the current time value set in 
step S404 or the last time desired body posture angle (at the time k-Ak) determined in step S414 described later). 
[0285] Alternatively, a more precise model (for example : the full model such as shown in Figure 12) may be used to 

30 determine the body vertical position. In this case, the body vertical position is determined in such a manner that the 
total center-of-gravity vertical position agrees with the current time value of the total center-of-gravity vertical position 
determined as described above. Here, the total center-of-gravity vertical position is determined by the current time 
value of the desired feet positions/postures determined as described above (value at the time k) , the desired body 
posture at the time (k-Ak) (or current time value of the reference body posture determined as described above), the 

35 current time value of the desired arm posture determined as described above (position of the center of gravity of the 
arms) , the body horizontal position at the time (k-Ak) and the body vertical position to be determined. 
[0286] In this case, the body posture and the body horizontal position at the time k are undetermined, and therefore, 
the values thereof at the time (k-Ak) are used instead thereof. For a higher precision, the estimated values thereof at 
the time k may be determined from the gait state at the time (k-Ak) by extrapolation. 

40 [0287] Then, the process proceeds to step S41 0, where based on the gait parameters (parameters defining the floor 
reaction force's horizontal component allowable range) determined in step S108 in Figure 15, the value (current time 
value) of the floor reaction force's horizontal component allowable range [Fxmin, Fxmax] at the time k shown in Figure 
18 is determined. 

[0288] Then, the process proceeds to step S412, where based on the simplified model in Figure 11, the current time 
45 values of the body horizontal acceleration and the body posture angular acceleration are determined in such a manner 
that the dynamical equilibrium condition concerning the desired ZMP (condition that the horizontal component of the 
moment caused about the desired ZMP by the resultant force of the inertial force of the robot 1 and the gravity is 0) is 
satisfied. However, the body horizontal acceleration and the body posture angular acceleration are determined in such 
a manner that the floor reaction force's horizontal component Fx doesn't exceed the range [Fxmin, Fxmax] and an 
50 equal body posture angular velocity is provided at the start and the end of the normal gait. Details thereof will be 
described below. 

[0289] Since the instantaneous values (current time values) of the foot position/posture and the body vertical position 
have been determined as described above at this point in time, the desired movement of the robot 1 except for the 
degree of freedom of the movement of the arm that involves a change of the angular momentum about the vertical 
55 axis can be determined uniquely by determining the body horizontal position and the body posture angle. Therefore, 
if the body horizontal position and the body posture angle are determined, all the quantities concerning the floor reaction 
force are uniquely determined except for the moment of the floor reaction force about the vertical axis. In this embod- 
iment, the desired floor reaction force's vertical component and the desired ZMP for the normal gait are defined by the 



39 

BNSDOCID: <EP 1473122A1. I > 



EP 1 473 122 A1 



floor reaction force's vertical component trajectory parameters and the desired ZMP trajectory parameters determined 
in step S022 in Figure 1 2, respectively. Therefore, of the quantities concerning the floor reaction force, only the floor 
reaction force's horizontal component is determined depending on the body horizontal position and the body posture 
angle determined. In addition, as described above, since the robot 1 has six degrees of freedom for each leg, the 
5 positions/postures of the parts of each leg 2 are uniquely determined from the desired foot position/posture and the 
desired body position/posture. The degree of freedom of the movement of the arm that involves a change of the angular 
momentum aboul the verlical axis is used to cancel a spinning force, as described later. 

[0290] In gait generation, if the desired ZMP is provided (the horizontal component of the floor reaction force moment 
about the desired ZMP is brought to 0) using primarily the body rotation mode rather than the body translation mode, 

10 there arises a possibility that the body posture angle fluctuates too largely. Thus, to avoid this, the body translation 
mode should bo used as far as circumstances permit. However, since the body translation mode involves a change of 
the floor reaction force's horizontal component, in the case where the floor reaction force's horizontal component al- 
lowable range is narrow, there is a possibility that the robot slips if the body translation mode works intensely. In such 
a case, the body rotation mode has to be used, fn particular, in a period in which the floor reaction force's horizontal 

15 component allowable range is 0 as in the case of the running gait, such a gait that produce a floor reaction force's 
horizontal component cannot be generated, and thus, the body rotation mode has to be used. In view of the points 
described above, in this embodiment, the body horizontal acceleration and the body posture angular acceleration are 
determined according to the flowchart shown in Figure 23. 

[0291 ] First, in step S500. a time Tm is set. The time Tm is an instant when the floor reaction force's vertical component 

20 has increased to a predetermined level during a second turning gait after the initial time Ts and the floating period of 
a first turning gait. I n addition , there is set a time Ts2 at wh ich the floor reaction force's vertical component has decreased 
to some degree in the latter half of the second turning gait. In addition, there is set a time Tm2 at which the floor reaction 
force's vertical component has increased to a predetermined magnitude in the next first turning gait after the floating 
period in the second turning gait. 

25 [0292] Figure 1 7 shows these times. The time Tm is preferably set to the instant when substantially the whole surface 
of the sole of the supporting leg's foot 22 comes into contact with the floor or a time immediately after the instant. The 
same holds true for the time Tm2. Besides, the time Ts2 is preferably set to the instant when the foot 22 having been 
in contact with the floor at substantially the whole surface of the sole thereof comes into contact with the floor only at 
the toe thereof or a time immediately before the instant. 

30 [0293] As for the relationship between the desired ZMP shown in Figure 19 determined in step S110 in Figure 15 
and the times Tm, Ts2 and Tm2, it is preferably that the time Tm is an instant when the desired ZM P, which has remained 
at an initial position, which is the position of the heel of the supporting leg's foot 22, until substantially the whole surface 
of the sole of the foot 22 comes into contact with the floor, starts moving toward the middle of the supporting leg's foot 
22. The time Ts2 is preferably set to an instant when the desired ZMP is completely shifted to the toe and only the toe 

35 of the supporting leg's foot 22 is in contact with the floor. In addition, the time Tm2 is preferably set to an instant, when 
the desired ZMP, which has remained at an initial position, which is the position of the heel of the supporting leg' s foot 
22, until substantially the whole surface of the sole of the foot 22 comes into contact with the floor, starts moving toward 
the middle of the supporting leg's foot 22. 

[0294] The reason why these times are determined as described above will be described later. 
40 [0295] Then, in step S502, it is determined whether the present time k (value indicated by a normal gait generation 
timer) lies between the time Ts and the time Tm or between the time Ts2 and the time Tm2. If the result of the deter- 
mination in step S502 is YES, the process proceeds to step S504, and if the result is NO, the process proceeds to step 
S518. 

[0296] In step S504, the body horizontal acceleration atmp is determined which is required to satisfy the current time 
45 desired ZMP (at the time k) (that is, to provide a floor reaction force moment about the desired ZMP of 0) in the case 
where the angular acceleration for the body rotation mode is set to 0 to make the robot 1 move in the body translation 
mode from the last time instantaneous gait state (gait state at the time k-1 ) of the robot 1 . The value atmp is determined 
using the formula a 10 concerning the simplified model (dynamics model) shown in Figure 11. More specifically, for 
example, the vertical accelerations of the supporting leg material particle 2m and the free leg material particle 2m at 
50 the present time k are determined using time series values of the desired foot position/posture determined before the 
present time k, and the vertical positions of the supporting leg material particle 2m and the free leg material particle 
2m are determined using the (current time) desired foot position/posture at the present time k. Besides, the vertical 
position of the body material particle 24m is determined using the (current time) floor reaction force's vertical position 
at the present time k, and the vertical acceleration of the body material particle 24m at the present time k is determined 
55 using time series values of the desired body vertical position determined before the present time k. Then, a formula 
obtained by substituting the determined values into the formula a10 and substituting 0 for My and d26by/dt2 in the 
formula a1 0 is solved with respect to the body material particle's horizontal acceleration d2Xb/dt2, thereby determining 
the body horizontal acceleration atmp in the form of the body material particle' s horizontal acceleration d2Xt/dt2. 
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[0297] In this embodiment, since the reference body posture is the vertical posture and the body posture angular 
acceleration depending on the reference body posture is 0 ; the body horizontal acceleration atmp is determined as- 
suming that the angular acceleration in the body rotation mode is 0. However, in the case where the reference body 
posture trajectory parameters are set so that the reference body posture varies and the reference body posture angular 
acceleration at the present time k which depends on the reference body posture has a value other than 0 ; the body 
horizontal acceleration atmp may be determined using the dynamics model by setting the angular acceleration for the 
body rotation mode to Lhe value of the reference body posture angular acceleration other than 0 (for example, the body 
horizontal acceleration atmp may be determined in the same manner as described above by setting d2eby/dt2 in the 
formula a1 0 to the value of the reference body posture angular acceleration other than 0). 

[0298] Then, the process proceeds to step S506, where the floor reaction force's horizontal component Fxtmp is 
determined using the formula a9 which relates the value of Fxtmp at the time k in the case where the body horizontal 
acceleration Is atmp with the simplified model shown in Figure 11 . That is, Fxtmp is determined using the following 
formula c1 7. In this formula, d2Xsup/dt2 and d2Xswg/dt2 represent the supporting leg's foot material particle horizontal 
acceleration and the free leg's foot material particle horizontal acceleration at the time k, respectively. 

Fxtmp = mb * atmp + msup * d2Xsup/dt2 

+ mswg * d2Xswg/dt2 formula d 7 



[0299] An example of Fxtmp thus determined Is shown in Figure 24. In Figure 24, the shaded areas indicate that 
Fxtmp exceeds the floor reaction force's horizontal component allowable range [Fxmin, Fxmax]. 
[0300] Then, the process proceeds to step S508, where the body horizontal acceleration a for the body translation 
mode, the floor reaction force's horizontal component Fx caused by the body horizontal acceleration, and the body 
25 angular acceleration p for the body rotation mode are determined in the following matter (S508 to S516). 
That is, 

If Fxtmp > Fxmax, the process proceeds to step S510, where Fx is determined by the following formula. 



Fx - Fxmax formula d 8 

If Fxtmp < Fxmin, the process proceeds to step S512. where Fx is determined by the following formula. 

Fx= Fxmin formula d 9 

Otherwise, that is, if Fxtmp lies within the floor reaction force's horizontal component allowable range [Fxmin, Fxmax], 
the process proceeds to step S514, where Fx is determined by the following formula. 

Fx - Fxtmp formula c20 

[0301] In any of the cases, the process then proceeds to step S516, where the body horizontal acceleration a and 
the body posture angular acceleration p are determined by the following formulas. 

a - atmp + (Fx-Fxtmp)/AFp formula c21 

p - (atmp - a) * AMp/AMr formula c22 

[0302] However, AFp, AMp and AMr are determined by the formulas c06, c07 and c09, respectively. 
[0303] For a higher precision of the dynamical calculation, after the body angular acceleration p is determined as 
described above, the body horizontal acceleration a for the body translation mode is preferably determined in an 
analytic or searching manner using a more precise dynamics model so that a composite movement of the body trans- 
lation mode and the body rotation mode having the body angular acceleration p satisfies the desired ZMP. As the 
determination method in a searching manner, the simplex method or a method of determining an affine Jacobian (sen- 
sitivitymatrix) and determining a next candidate by the pseudo Newton method may be used. 
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[0304] Furthermore, in order to entirely prevent the floor reaction force's horizontal component Fx from exceeding 
the floor reaction force's horizontal component allowable range [Fxmin, Fxmax], a set of the body horizontal acceleration 
a and the body angular acceleration p may be determined in a searching manner in such a manner that Fx = Fxmax 
and the horizontal component of the floor reaction force moment about the desired ZMP is 0 instep S510 orFx = Fxmin 

5 and the horizontal component of the floor reaction force moment about the desired ZMP is 0 in step S512, 

[0305] Fx thus determined is shown in Figure 25. This Fx is Fxtmp that is limited (saturated) not to exceed the floor 
reaction force's horizontal component allowable range [Fxmin, Fxmax]. More specifically, if Fxtmp associated with the 
body horizontal acceleration atmp of the body translation mode falls within the allowable range [Fxmin, Fxmax], Fxtmp 
is adopted as Fx as it is. On the other hand, if Fxtmp associated with the body horizontal acceleration atmp of the body 

10 translation mode is larger than the upper limit of the allowable range [Fxmin, Fxmax] or is smaller than the lower limit 
thereof, Fx is forcedly limited to Fxmax or Fxmin, respectively. In particular, during the floating period in the running 
gait, since Fxmax and Fxmin are always 0 (Fxmax = Fxmin =0), Fx is also 0 (Fx = 0). 

[0306] in addition, the body posture angular acceleration j} thus determined is also shown in Figure 26. An insufficient 
floor reaction force moment due to limitation of the acceleration for the body translation mode intended for preventing 

15 Fx caused in the body translation mode from exceeding the allowable range [Fxmin, Fxmax] is compensated for by 
the body rotation mode (specifically, the insufficient floor reaction force moment is the inertial force moment required 
for providing a horizontal component of the floor reaction force moment about the desired ZMP of 0 minus a moment 
component due to the limited body horizontal movement and the movements of the legs 2, 2). During the floating period 
of the running gait, the body horizontal acceleration a of the body translation mode is always limited to 0, and therefore, 

20 the insufficient floor reaction force moment described above is compensated for only by the body posture angular 
acceleration ^ of the body rotation mode. 

[0307] Described above is the processings performed in the case where the time k lies between the time Ts and the 
time Tm or between the time Ts2 and the time Tm2. 

[0308] If the result of the determination in step S502 is NO, the following processings are performed. First, the process 
25 proceeds to step S51 8, where there is set a pattern of a ZMP-converted value of the floor reaction force moment which 
produces a body posture angular acceleration for returning the body posture angular velocity to the initial value (which 
is the value at the time Ts if the present time k is ahead of the time Ts2, or otherwise, the value at the time Ts2) by the 
time Ts2 if the present time k is ahead of the time Ts2, or otherwise, by the time Te (the ZMP-converted value of the 
floor reaction force moment is referred to as a body posture restoring moment ZMP-converted value and abbreviated 
30 as ZMPrec, hereinafter). 

[0309] This will be described in detail below. The processings performed if the present time k is subsequent to the 
time Tm2 are the same as those performed if the present time k is ahead of the time Ts2, and therefore, only the 
processings performed if the present time k is ahead of the time Ts2 will be described. 

[0310] It is to be considered to return the body posture angular velocity to the initial value (value at the time Ts) by 
35 producing the body posture angular acceleration using the body rotation mode in a period from the time Tm to the time 
Ts2. A body posture angular acceleration pattern for this is denoted by p(k). 

[0311] In the body rotation mode, when trying to produce the body posture angular acceleration (3(k), a floor reaction 
force moment P(k) * AMr is produced. As a result, assuming that the floor reaction force' s vertical component at that 
instant is Fz (k) , the ZMP (k) calculated from the movement (rather than the desired ZMP) is shifted by AZMP deter- 
40 mined by the following formula. 

AZMP(k) - -p(k) * AMr/Fz(k) formula c23 

45 [0312] Therefore, if the patterns of AMr and Fz (k) are determined (known), the body posture angular acceleration 
pattern that satisfies the formula c23 can be produced by appropriately setting the pattern of AZMP(k), and thus, the 
body posture angular velocity can be returned to the initial value (value at the time Ts) , that is, to the body posture 
angular velocity in the initial state of the reference body posture trajectory (at the time Ts). 

[0313] The "body posture restoring moment ZMP-converted value (ZMPrec) " means AZMP (k) that is appropriately 
50 set in this way. Strictly speaking, when the body posture restoring moment ZM P-converted value is set using the formula 
c23, AMr varies. However, it may be set to an approximate constant value. The reason for this is that the normal gait 
doesn't require a quite high dynamical precision because the normal gait generated is a provisional one and the actual 
robot doesn't follow the gait. 

[0314] Figure 27 shows an example of ZMPrec. In Figure 27, ZMPrec has a trapezoidal pattern. The times of the 
55 apexes of the trapezoidal pattern agree with the times of the apexes of the desired ZMP pattern in the period from the 
time Tm to the time Ts2 (see Figure 1 9). This is intended for simplifying modification of the desired ZMP pattern of the 
current time gait, as described later. If ZMPrec is substituted for AZMP (k) in the formula c23, the following formula 
results. 



42 



BNSDOCID: <EP . 1473122A1J _> 



EP1 473 122 A1 



p(k) - -ZMPrec * Fz(k)/AMr formula c24 

Therefore, p(k) determined by the formula c24 is as shown by the solid line in Figure 28. The dotted line in Figure 28 

5 shows the body posture angular velocity from the time Ts to the time Tm (shown by the solid line in Figure 26). 

[0315] For the normal gait, the body posture angular velocity at the UmeTs2 preferably agrees with the body posture 
angular velocity at the time Ts. This is because such agreement provides reduced variation of the body posture angle. 
[0316] Thus, in order to make the body posture angular velocity at the time Ts2 agree with the body posture angular 
velocity at the time Ts the body posture angular acceleration pattern is set in such a manner that the integral of the 

10 body posture angular acceleration p for the period from the time Ts to the time Ts2 is 0. That is, the body posture 
angular acceleration pattern is set in such a manner that the integral of fJ(k) for the period from the time Tm to the time 
Ts2 (i.e., integral for the solid line section in Figure 28) equals to the integral of the body posture angular acceleration 
for the period from the time Ts to the time Tm (determined in steps S504 to S516 as described above) (i.e., integral 
for the dotted line section in Figure 28, in other words, the difference between the body posture angular velocity at the 

15 time Tm and the body posture angular velocity at the time Ts) multiplied by -1 . 

[0317] More specifically in this embodiment in the trapezoidal pattern of ZMPrec shown in Figure 27, by assuming 
that the times of the apexes of the trapezoid (determined based on the desired ZMP trajectory for the normal gait as 
described above) are known, and the height of the trapezoid is unknown, the height of the trapezoid of ZMPrec that 
satisfies the above-described relationship (parameter that defines the ZMPrec pattern) can be determined. 

20 [031 8] The height of the trapezoid of ZM Prec for the f i rst turn ing gait is referred to as a first turning gait's body posture 
restoring moment's ZMP-converted value's trapezoid height acyd . The height of the trapezoid of ZMPrec for the second 
turning gait is referred to as a second turning gait's body posture restoring moment's ZMP-converted value's trapezoid 
height acyc2. ZMPrec for the second turning gait is a trapezoidal pattern set in the period from the time Tm2 to the 
time Te. 

25 [0319] Furthermore, as far as the gait parameters are not changed in the process of generation of one step of the 
current time gait, the ZMPrec patterns for the period between the time Tm and the time Ts2 and the period between 
the time Tm2 and the timeTe determined in step S518 are the same (i.e., the same parameter values are calculated), 
and therefore, the processing of step S518 may be performed only at the times Tm and Tm2. 

[0320] Then, the process proceeds to step S520, where the instantaneous value (current time value) of the body 
30 posture restoring moment's ZM P -converted value ZMPrec at the time k is calculated based on the parameter (trapezoid 
height) determined as described above. 

[0321] Then, the process proceeds to step S522, where the instantaneous value (current time value) p of the body 
posture angular acceleration pattern at the time k is calculated using the formula c24. 

[0322] Then , the process proceeds to step S524, where the body horizontal acceleration atmp required for satisfying 
35 the current time (time k) desired ZM P in the case where the robot moves only in the body translation mode without the 
movement in the body rotation mode from the last time instantaneous desired gait state (desired gait state at the time 
k-1) is determined using the dynamics model of the robot 1. This calculation is performed in the same manner as in 
step S504. 

[0323] Then, the process proceeds to step S526, where the body horizontal acceleration a for the body translation 
40 mode is calculated using the following formula. 

ex = atmp - (AMr/AMp) * p formula c25 

45 [0324] Then, the process proceeds to step S528, where the floor reaction force's horizontal component Fx at the 
time k for the body horizontal acceleration of a is determined using the following formula c26 similar to the formula c1 7. 

Fx = mb * a + msup * d2Xsup/dt2 

50 

+ mswg * d2Xswg/dt2 formula c26 

[0325] Incidentally, for a higher precision of the dynamical calculation, after the body angular acceleration p is de- 
termined as described above, instead of calculating the body horizontal acceleration a using the formula c25 in step 
55 S526, the body horizontal acceleration a for the body translation mode is preferably determined in an analytic or search- 
ing manner using a more precise dynamics model so that a composite movement of the body translation mode and 
the body rotation mode having the body angular acceleration p satisfies the desired ZMP, as supplementaly described 
concerning step S516, 
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[0326] Described above is the processings performed in the case where the time k is not included in any of the 
periods between the time Ts and the time Tm and between the time Ts2 and the time Tm2. 

[0327] The floor reaction force's horizontal component Fx provided when the above-described processings to the 
time Ts2 are completed is shown in Figure 29. In addition, the floor reaction force's horizontal component Fx and the 

5 body posture angular acceleration p provided when the above-described processings to the time Te are completed are 
shown in Figures 30 and 31 . respectively. The processing of step S412 described above (subroutine for determining 
the body horizontal acceleration and the body posture angular acceleration) is to determine the instantaneous values 
of the body horizontal acceleration and the body posture angular acceleration at the time k. rather than to collectively 
generate the time series values thereof to the time Te. 

10 [0328] In this embodiment, since the reference body posture is the vertical posture, and the body posture angular 
acceleration depending on the reference body posture is 0, the angular acceleration (3 for the body rotation mode 
determined as described above is regarded as the body posture angular acceleration determined in the processing of 
step S412. However, if the reference body posture trajectory parameters are set in such a manner that the reference 
body posture varies, the sum of the angular acceleration (3 for the body rotation mode determined as described above 

15 and the reference body posture angular acceleration should be regarded as the body posture angular acceleration 
determined in the processing of step S412. 

[0329] The times Ts, Tm, Ts2 and Tm2 are set as described above to prevent the floor reaction force's horizontal 
component Fx from exceeding the allowable range [Fxmin, Fxmax] even if the body posture angular acceleration (3 is 
produced so as to return the body posture angular velocity to the initial angular velocity of the reference body posture 

20 trajectory in the periods between the time Tm to the time Ts2 and between the time Tm2 and the time Te. In other 
words, during the periods from the time Tm to the time Ts2 and from the time Tm2 to the time Te : the floor reaction 
force's horizontal component allowable range is sufficiently wide, and therefore, even if the body posture angular ac- 
celeration p is produced to return the body posture angular velocity to the initial value while satisfying the desired ZMP, 
the floor reaction force's horizontal component Fx doesn't exceed the allowable range. 

25 [0330] Alternatively, rather than making the body posture angular velocity at the time Ts agree with the body posture 
angular velocity at the time Ts, assuming that acyd and acyc2 have an equal value (assuming that acyd = acyc2), 
the value of acyd and acyc2 may be determined so as to make the body posture angular velocity at the time Te agree 
with the body posture angular velocity at the time Ts. 

[0331] Then, the process proceeds to step S414 in Figure 22, where the body horizontal velocity is determined by 
30 integrating the body horizontal acceleration determined in step S412 (cumulatively summing the body horizontal ac- 
celeration values from the time Ts to the present time k) , and the body horizontal position (current time value) is 
determined by integrating the body horizontal velocity (cumulatively summing the body horizontal velocity values from 
the time Ts to the present time k). In addition, the body posture angular velocity is determined by integrating the body 
posture angular acceleration determined in step S412 (cumulatively summing the body posture angular acceleration 
35 values from the time Ts to the present time k), and the body posture angle (current time value) is determined by inte- 
grating the body posture angular velocity (cumulatively summing the body posture angular velocity values from the 
time Ts to the present time k). 

[0332] After the normal gait's instantaneous value determination subroutine of step S306 in Figure 21 is conducted 
as described above, the process proceeds to step S308, where the value of the gait generation time k is incremented 

40 by the gait generation interval Ak. Then, the process returns to step S304, and as far as the condition shown in step 
S304 is satisfied, the processings of steps S306 and S608 are repeated. If the condition shown in step S304 is not 
satisfied, that is, if the generation of the provisional normal gait to the end thereof (to the time Te - Ts + Tcyc) is 
completed, the process proceeds to step S310. In step S310, the initial (time Ts) body posture angle and the initial 
(time Ts) body posture angular velocity are modified in accordance with the following formulas based on the final (time 

45 Te) body posture angle of the provisional gait determined as described above or the like. This modification is intended 
for satisfying the boundary requirements of the normal gait concerning the body posture angle and the angular velocity 
thereof (that is, both the body posture angle and the angular velocity thereof are the same at the start and the end of 
the normal gait). In this description, it is assumed that the gait of the robot 1 is one with which the robot 1 moves straight. 
[0333] In this case, renewed values in the following formulas are the modified values. 

50 

renewed initial body posture angular velocity 
=- initial body posture angular velocity for the 

55 

provisional gait 
- (final body posture angle for the provisional gait 
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- initial body posture angle for the provisiona! 

gait)/Tcyc formula c30 

5 

renewed initial body posture angle = initial (timeTs) 

reference body posture angle formula c31 

10 

[0334] Now, a reason why the initial state posture angular velocity is modified using the formula c30 will be described 
below. For the normal gait, the initial state posture angle and the angular velocity thereof have to be determined to 
avoid the movement of the robot 1 from being discontinuous at the boundaries between the gaits when the gait is 
repeated (to satisfy the boundary requirements). In this case, the final body posture angular velocity for the provisional 
15 normal gait thus determined agrees with the initial body posture angular velocity's initial value (reference body posture 
angular velocity's initial value) since the body posture angular acceleration pattern associated with the body posture 
restoring moment ZMP-converted value ZMPrec is set. Therefore, if the following formula, which is the remaining 
requirement, is satisfied, the above-described requirements concerning the body posture angle and the angular velocity 
thereof are satisfied. 

20 

final body posture angle = initial body posture angle formula c32 

[0335] In addition, there is a relationship expressed by the following formula. 

25 

second order differential of the body posture angle = body 

posture angular acceleration formula c33 

30 

Therefore, second-order integrating the both sides of the formula C33 for the period from the start to the end of the 
normal gait provides the following relationship. 

35 final body posture angle = initial body posture angle 

+ initial body posture angular velocity * Tcyc 
+ second order integral of the body posture angular 

40 

acceleration formula c34 

[0336] On the other hand, in normal gait generation, the horizontal acceleration (horizontal acceleration/deceleration) 
of the body 24 is adjusted using primarily the body translation mode for satisfying the desired ZMP as described above. 
45 However, if the horizontal acceleration of the body 24 that satisfies the desired ZMP cannot produced adequately (if 
a sufficient friction force cannot be produced), the insufficient body horizontal acceleration for the body translation 
mode is compensated for by adj usting the angular acceleration of the body posture angle while keeping constant the 
total center-of-gravity acceleration using the body rotation mode. 

[0337] The adjustment of the body posture angular acceleration using the body rotational movement mode is ap- 
se proximately equivalent to adjustment of the angular acceleration of the flywheel FH of the robot 1 shown in Figure 11 . 
If the rotational velocity of the flywheel FH is close to 0 ; no gyro effect occurs, and the force caused by the flywheel 
FH is determined only by the angular acceleration of the flywheel FH. Therefore, in the robot 1 having the flywheel FH 
in the body 24, even if the initial angle and the initial angular velocity of the flywheel FH vary slightly, substantially 
constant force is produced as far as the flywheel FH moves with an angular acceleration of a same pattern. Therefore, 
55 in the formulas a8. a9 and a10, which are robot dynamics equations, the gyro effect is neglected. Therefore, for the 
robot 1 according to this embodiment, according to any of the formulas a8, a9 and a10 and a more general and precise 
dynamics model, even when the initial body posture angle and the initial angular velocity vary slightly, substantially the 
same resultant force of the inertia! force and the gravity is produced as far as the body posture angle is changed with 
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an angular acceleration of a same pattern while maintaining a constant total center-of-gravity acceleration (that is, as 
far as the body posture angle is changed with an angular acceleration of a same pattern in the body rotational movement 
mode). In other words, even if the initial body posture angle andthe initial angular velocity vary slightly, the body posture 
angular acceleration for the gait generated according to the flowchart described above is not changed. 
5 [0338] That is : the second order integral of the body posture angular acceleration in the formula c34 is independent 
of the initial body posture angle and the Inilial angular velocity. That is, the second order integral of the body posture 
angular acceleration in the formula c34 can be treated as a constanl value regardless of the values of the initial body 
posture angle and the initial angular velocity. 

[0339] Since the final body posture angle is the final body posture angle for the provisional gait when the value of 
io the initial body posture angle is the initial body posture angle for the provisional gait, and the value of the initial body 
posture angular velocity is the initial body posture angular velocity for the provisional gait, applying this relationship to 
the formula c34 results in the following formula. 



15 



20 



25 



30 



35 



final body posture angle for the provisional gait = initial 
body posture angle for the provisional gait 
+ second order integral of the body posture angular 
acceleration 
+ initial body posture angular velocity for the 

provisional gait * Tcyc formula c35 

Thus, the following formula results. 

second order Integral of the body posture angular acceleration 
= (final body posture angle for the provisional gait 
- initial body posture angle for the provisional gait) 
- initial body posture angular velocity for the 

provisional gait * Tcyc formula c36 



40 Since, from the above discussion, it is seen that the second order integral of the body posture angular acceleration 
can be treated as a constant (the second order integral of the body posture angular acceleration is independent of the 
initial body posture angle and the initial angular velocity), substituting the above formula into the formula c34 results 
in the following formula. 

45 

final body posture angle = initial body posture angle 
+ (final body posture angle for the provisional gait 
5Q - initial body posture angle for the provisional gait) 

- initial body posture angular velocity for the 
provisional gait * Tcyc 

55 

■+- initial body posture angular velocity * Tcyc formula c37 

From the formulas c37 and c32, the above-described formula c30 is provided. 
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[0340] In this embodiment the initial body posture angle the initial body posture angle agrees with the initial value 
of the reference body posture angle as expressed by the formula c31 . However, the initial body posture angle may be 
set so that the average value of the body posture angles for the normal gait agrees with the initial value of the reference 
body posture angle. Alternatively, the initial body posture angle may be set so that the average value of the maximum 

5 and the minimum of the body posture angle for the norma! gait agrees with the initial value of the reference body angle. 
[0341] Furthermore, while a case where the roboL 1 moves only straight is described above : when determining a 
normal gait including a turning movement, the robot 1 travels in different directions at the start and the end of the normal 
gait. Therefore, the initial body posture angular velocity depends on the initial body posture angle, Therefore, the initial 
body posture angle and the initial angular velocity have to be determined considering this fact. In this case, for example, 

10 the initiat body posture angle and the initial body posture angular velocity may be updated so that the following formulas 
c37a and c37b are satisfied. 



15 



final body posture angle - initial body posture angle 
= second order integral of the body posture angular 
acceleration determined so as to satisfy the floor reaction 
20 force's horizontal component allowable range 

+ second order integral of the body posture angular 
acceleration caused by ZMPrec 

25 

+ initial body posture angular velocity * period of the 

normal gait formula c37a 

30 

final body posture angular velocity - initial body posture 
angular velocity 
= first order integral of the body posture angular 
acceleration determined so as to satisfy the floor reaction 
force's horizontal component allowable range 
+ first order integral of the body posture angular 

acceleration caused by ZMPrec c formula 37b 

45 [0342] For the formulas c37a and c37b, the integral time for the first term in the right side thereof is a sum of the 
period from the time Ts to the time Tm and the period from the time Ts2 to the time Tm2, and the integral time for the 
second term in the right side thereof is a sum of the period from the time Tm to the time Ts2 and the period from the 
time Tm2 to the time Te. 

[0343] More specifically, in the normal gait, the initial state posture angle and the initial state angular velocity seen 
so from the first turning gait's supporting leg coordinate system (next time gait's supporting leg coordinate system) have 
to agree with the final body posture angle and the final angular velocity seen from the next first turning gait's supporting 
leg coordinate system (next time gait's supporting leg coordinate system), respectively. Thus ; in this embodiment, the 
renewed initial body posture angle is determined by the formula c31 , and the renewed initial body posture angie and 
a value seen from the next but two gait's supporting leg coordinate system derived from the renewed initial body posture 
55 angle by coordinate transformation thereof using a matrix corresponding to the total turning angle of the robot 1 in the 
normal gait (turning angle about the vertical axis (rotating coordinate transformation matrix) are substituted for the 
initial body posture angie and the final body posture angle in the left side of the formula c37a, respectively. Besides, 
as the body posture angular acceleration concerning the integration in the first term of the right side of each of the 
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formulas c37a and c37b, the one determined successively in step S516 in Figure 23 is used 

[0344] Then, assuming that the initial body posture angular velocity in the formulas c37aand c37b and the trapezoid 
height of ZMPrec (the trapezoidal pattern shown in Figure 27) concerning the integration in the second term of the 
right side of the formulas c37a and c37b are unknown quantities (where the times of the apexes of the ZMPrec trap- 

5 ezoidal pattern are previously determined, and the trapezoidheight acyd of ZMPrec for the first turning gait equals to 
the trapezoid height acyc2 of ZM Prec for the second turning gait), the simultaneous equations c37a and c37b including 
these unknown quantities are solved to determine the initial body posture angular velocity as the renewed initial body 
posture angular velocity. In this case, the final body posture angular velocity in the formula c37b is a value seen fromthe 
next time gait's supporting leg coordinate system derived from the unknown initial body posture angular velocity by 

10 coordinate transformation using the matrix corresponding to the total turning angle in the normal gait. 

[0345] In the case where the robot 1 makes a movement including turning, the renewed initial body posture angle 
and the renewed initial angular velocity may be determined as described above. 

[0346] The initial body posture angular velocity that satisfies the boundary requirements of the normal gait may be 
determined in a searching manner. 

15 [0347] After the processing of step S310 in Figure 21 is completed, the process proceeds to step S21 0 in Figure 20, 
where the final body horizontal position/velocity for the gait generated (provisional normal gait) are converted into 
values seen from a supporting leg coordinate system associated with the supporting leg at that instant (that is, X ,M , Y"\ 
Z" 1 coordinate system in Figure 32), and the values are denoted by (Xe, Vxe) where Xe denotes a final body horizontal 
position and Vxe denotes a final body horizontal velocity. 

20 [0348] Then, the process proceeds to step S212. where the difference between the initial body horizontal position/ 
velocity (Xs, Vxs) and the final body horizontal position/velocity (Xe, Vxe) is calculated as shown in the drawing. The 
difference (Xs-Xe, Vxs-Vxe) is referred to as a body horizontal position/velocity boundary requirement error (errx, 
errvx). Since the boundary requirements have to be satisfied in the normal gait, (xs, Vxs) has to agree with (Xe, Vxe). 
Therefore, the body horizontal position/velocity boundary requirement error (errx, errvx) has to be 0 or approximately 

25 o. In this embodiment, (Xs, Vxs) that provides a body horizontal position/velocity boundary requirement error (errx, 
errvx) of approximately 0 is determined in a searching manner as described below. 

[0349] Then, the process proceeds to step S214, where it is determined whether the calculated body horizontal 
position/velocity boundary requirement error (errx, errvx) falls within an allowable range previously appropriately set. 
Instead of setting the allowable range for the body horizontal position/velocity boundary requirement error as described 
30 above, it may be determined whether the difference between the initial divergence component (Xs+VxsAo0) and the 
final divergence component (Xe+Vxe/u>0) and the difference between the initial convergence component (Xs-Vxs/wO) 
and the final convergence component (Xe-VxeAoO) fall within respective allowable ranges. As described earlier, o>0 is 
a predetermined value. 

[0350] If the result of the determination in step S214 is NO, the process proceeds to step S216. In step S216, a 
35 plurality of (two, in this embodiment) initial value candidates (Xs+AXs, Vxs), (Xs, Vxs+AVxs) are determined in the 
vicinity of (Xs, Vxs). Here, AXs and AVxs mean a predetermined small variations of Xs and Vxs, respectively. Assuming 
that each of these initial value candidates is an initial state of the body horizontal position/velocity, a normal gait is 
generated using gait parameters in the same manner as in the processing of step S208. Furthermore, values (Xe+AXe1 , 
Vxe+AVxe1) and (Xe+AXe2, Vxe+AVxe2) seen from the supporting leg coordinate system associated with the sup- 
40 porting leg at that instant converted from the final body position/velocity of the generated normal gait are determined. 
Here, (Xe+AXe1 , Vxe+AVxe1 ) indicates the final body position/velocity corresponding to (Xs+AXs, Vxs), and (Xe+AXe2, 
Vxe+AVxe2) indicates the final body position/velocity corresponding to (Xs, Vxs+AVxs). In this processing of normal 
gait (provisional gait) generation, the initial states (states at the time Ts) of the variables other than the body horizontal 
position/velocity may be set the same as in the case where the initial value candidate of the body horizontal position/ 
45 velocity is (Xs, Vxs), for example. In step S216, in addition, the difference between each initial value candidate and 
the final body position/velocity corresponding thereto, that is, the body horizontal position/velocity boundary require- 
ment error for each of the initial value candidates (Xs+AXs, Vxs) and (Xs, Vxs+AVxs) is determined in the same process- 
ing as that of step S210. 

[0351] Then, the process proceeds to step S218, where based on the body horizontal position/velocity boundary 
50 requirement error for each of (Xs, Vxs) and the initial value candidates in the vicinity thereof (Xs+AXs, Vxs) and (Xs, 
Vxs+AVxs), an initial value candidate following (Xs : Vxs) is determined by a searching method (for example, the simplex 
method or a method of determining an affine Jacobian (sensitivity matrix) and determining a next candidate by the 
steepest descent method). That is, from the body horizontal position/velocity boundary requirement error for each of 
(Xs, Vxs) and the initial value candidates in the vicinity thereof (Xs+AXs, Vxs) and (Xs, Vxs + AVxs), a sensitivity matrix 
55 that indicates the degree of change of the body horizontal position/velocity boundary requirement error caused when 
the body horizontal position and the body horizontal velocity are each slightly changed from the initial value candidates 
Xs and Vxs, respectively, and based on the sensitivity matrix, an initial value candidate (Xs, Vxs) that provides further 
reduced body horizontal position/velocity boundary requirement error is newly determined. Then, once the new initial 
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value candidate (Xs, Vxs) for the body horizontal position/velocity is determined, the process returns to step S206. 
[0352] As far as the result of the determination in step S214 is NO, the processings described above (steps S206 
to S218) are repeated In this case, in step S300 (see Figure 21) in the process of normal gait generation (step S208) 
for the new initial value candidate (Xs. Vxs) of the body horizontal position/velocity, the initial value of the body posture 

5 angular velocity is set to the value determined in step S31 0 (see Figure 20) in the processing of step S208 for the last- 
lime's initial value candidate (Xs ; Vxs) of the body horizontal position/velocity, rather than the initial value of the refer- 
ence body posture angular velocity. Then, if the result of the determination in step S214 is YES, the repetition loop 
(step S204) is exited, and the process proceeds to step S220. The provisional normal gait generated immediately 
before exiting the repetition loop of step S204 is adopted as the normal gait that satisfies the boundary requirements. 

10 [0353] In step S220, the initial body horizontal position/velocity (X0, V0) at the original initial time 0 (end time of the 
current time gait), the initial body vertical position/velocity (Z0, VzO) at the initial time 0, and the initial body posture 
angle and the initial angular velocity at the initial time 0 are determined. 

[0354] Specifically, (X0, V0) and (Z0, VzO) are set to values seen from the supporting leg coordinate system (X m , 
Y"\ Z m coordinate system in Figure 32) for the supporting leg for a step starting at the time Tcyc (that is, the second- 

15 time first turning gait) which are converted from the body horizontal position/velocity and the body vertical position/ 
velocity determined at the instant when switching from the second turning gait to the second turning gait occurs in 
steps S408 and S414 in the normal gait instantaneous value determination subroutine shown in Figure 22, that is : at 
the time k = Tcyc (time Te-Ts). Similarly, the initial state posture angle and the initial state angular velocity are set to 
values seen from the supporting leg coordinate system (X m , Y"\ Z"' coordinate system in Figure 32) for the supporting 

20 teg for a step starting at the time Tcyc (thatis, the second-time first turning gait) which are converted from the body 
posture angle and the angular velocity determined at the time k = Tcyc (time Te-Ts). 

[0355] Then, the process proceeds to step S222, where the normal gait's initial divergence component q [ 0 ] is 
determined by the following formula. 

25 

q[0] - X0 + VO/coO formula 40 



As described in the explanation about divergence, o>0 is a predetermined value. 

[0356] Then, the process proceeds to step S224, where the normal gait's initial divergence component q[0] is con- 
30 verted into a value seen from the current time gait's supporting leg coordinate system, and the resulting value is de- 
termined as q"[0]. The initial body vertical position/velocity (Z0, VzO) is converted into a value seen from the current 
time gait's supporting leg coordinate system, and the resulting value is determined as (Z0" VzO"). 
[0357] Specifically, (Z0" VzO") agrees with the body vertical position/velocity at the end of the second turning gait 
seen from the second turning gait's supporting leg coordinate system (X", Y", Z" coordinate system in Figure 16). 
35 Besides, q"[0] also agrees with the final divergence component of the second turning gait seen from the second turning 
gait's supporting leg coordinate system (X", Y", Z" coordinate system in Figure 15). Therefore, (Z0'\ VzO" ) and q" [0 ] 
may be calculated using these characteristics. 

[0358] Then, the processing of step S024 in Figure 13, that is, the subroutine processing for determining the initial 
states of the normal gait, is completed. 
40 [0359] Then, the process proceeds to step S026 in Figure 13, where the gait parameters for the current time gait 
are determined (some of them are provisionally determined). In step S026, a process described below is conducted 
in accordance with the flowchart shown in Figure 33. 

[0360] First, in step S600, the foot trajectory parameters for the current time gait are set in such a manner that the 
foot position/posture trajectory for the current time gait connects to the foot position/posture trajectory for the normal 

45 gait 

[0361] Specifically, the current time gait's free leg's foot position/posture (initial value of the current time gait's free 
leg's foot position/posture) is set to the current free leg position/posture seen from the current time gait's supporting 
leg coordinate system (free leg position/posture at the end of the last time gait). The supporting leg's foot position/ 
posture at the start of the current time gait (initial value of the current time gait's supporting leg's foot position/posture) 

50 is set to the current supporting leg's foot position/posture seen from the current time gait's supporting leg coordinate 
system (supporting leg's foot position/posture at the end of the last time gait). In addition, the free leg's foot position/ 
posture at the end of the current time gait is determined in accordance with the next time gait's supporting leg coordinate 
system seen from the current time gait's supporting leg coordinate system (that, is, in accordance with the required 
value of the free leg landing position/posture for the first step of the current time gait). That is, the free leg's foot position/ 

55 posture at the end of the current time gait is determined in such a manner that, when the free leg's foot 22 is rotated 
from the free leg's foot position/posture at the end of the current time gait until substantially the whole surface of the 
sole of the foot 22 comes into contact with the floor while keeping the foot in contact with the floor without slipping, the 
representative point of the foot 22 agrees with the origin of the next time gait's supporting leg coordinate system seen 
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from the current time gait's supporting leg coordinate system. 

[0362] At the end of the current time gait, the supporting leg's foot 22 is away from the floor and floats in the air. To 
determine the trajectory after the supporting leg's foot 22 takes off the floor, the expected landing position/posture of 
the supporting leg's foot is set. The expected landing position/posture of the supporting leg's foot is set in accordance 

5 with the next but one time gait's supporting leg coordinate system seen from the current time gait's supporting leg 
coordinate system (that is, in accordance with the required value of the free leg's foot position/posture for the second 
step of the current time gait). More specifically, the expected landing position/posture of the supporting leg's foot is set 
in such a manner that, when the foot 22 is rotated from the position/posture until substantially the whole surface of the 
sole of the foot 22 comes into contact with the floor while keeping the foot 22 in contact with the floor without slipping, 

10 the representative point of the foot 22 agrees with the origin of the next but one time gait's supporting leg coordinate 
system seen from the current time gait' s supporting leg coordinate system. 

[0363] The supporting leg's foot position/posture at the end of the current time gait is determined using the finite 
duration settling filter to generate, until the end of the current time gait the foot position/posture trajectory that leads 
from the current supporting leg position/posture (supporting leg's foot position/posture at the start of the current time 

15 gait) to the expected foot landing position/posture associated with the next time gait' s supporting leg coordinate system 
(required value of the free leg's foot landing position/posture for the second step of the required parameters). 
[0364] Then, the process proceeds to step S602, where the reference body posture trajectory parameters for the 
current time gait are determined in the same manner as the first and second turning gaits of the normal gait. However, 
the parameters are set in such a manner that the reference body posture trajectory for the current time gait is seamlessly 

20 connected to the reference body posture trajectory for the normal gait (that is, the reference body posture angle and 
the angular velocity at the end of the current time gait agree with the reference body posture angle and the angular 
velocity at the start of the normal gait, respectively). In this embodiment, both for the current time gait and the normal 
gait, the reference body posture is constantly the vertical posture. 

[0365] Then, the process proceeds to step S604, where the arm posture trajectory parameters for the current time 
25 gait are determined in the same manner as the first and second turning gaits of the normal gait. The parameters are 
set in such a manner that the arm posture trajectory for the current time gait is continuously connected to the arm 
posture trajectory for the normal gait. The arm posture trajectory parameters determined in this step are movement 
parameters other than the parameter concerning a change of the angular momentum of the arms about the vertical 
axis (or body trunk axis), which define the trajectory of the position of the center of gravity of the arms, as with the 
30 normal gait parameters determined in step S1 04 in Figure 15. 

[0366] Then, the process proceeds to step S606, where the floor reaction force's vertical component trajectory pa- 
rameters for the current time gait are set in such a manner that the floor reaction force's vertical component trajectory 
defined by the parameters is substantially continuous (i.e., has no step-wise discrete values) as shown in Figure 6, as 
with the first and second turning gaits of the normal gait. 
35 [0367] The floor reaction force's vertical component trajectory parameters are set in such a manner that both the 
total center-of-gravity vertical position/posture and the floor reaction force's vertical component trajectory are contin- 
uously connected to those of the normal gait. 

[0368] Specifically, based on the value (ZO", VzO") seen from the current time gait's supporting leg coordinate system 
converted from the initial body vertical position/velocity for the normal gait finally determined in the processing of step 

40 S024in Figure 13 (processing for determining the initial state of the normal gait), that is, the value (ZO", VzO") determined 
in step S224 in Figure 20 or the like, the initial total center-of -gravity position/velocity for the normal gait seen from the 
current time gait's supporting leg coordinate system is determined using the formula b11 (or kinematics model of the 
robot 1) , for example. Specifically, the initial total center-of-gravity vertical position for the normal gait seen from the 
current time gait's supporting leg coordinate system is determined by substituting, into the formula b11 , the body ma- 

^5 terial particle vertical position in the simplified model in Figure 11 corresponding to the body vertical position Z0" for 
the normal gait determined in step S224 and the leg material particle vertical positions for the supporting leg and the 
free leg corresponding to the values seen in the current time gait's supporting leg coordinate system converted from 
the foot positions thereof at the start of the normal gait. Besides, the initial total center-of-gravity vertical velocity for 
the normal gait seen from the current time gait's supporting leg coordinate system is determined by substituting, into 

50 a formula obtained by differentiating the both sides of the formula b1 1 , the body material particle vertical velocity in the 
simplified model in Figure 11 corresponding to the body vertical velocity VzO" for the normal gait determined in step 
S224 and the leg material particle vertical velocities for the supporting leg and the free leg corresponding to the values 
seen in the current time gait's supporting leg coordinate system converted from the foot vertical velocities thereof at 
the start of the normal gait. The calculation of the initial total center-of-gravity vertical position/velocity may be performed 

55 using a more precise model. 

[0369] Then, the initial total center-of-gravity vertical position/velocity for the normal gait thus determined is substi- 
tuted for the final total center-of-gravity vertical position/velocity in the formula d 3 and the following formula c41 , and 
the last-time desired gait instantaneous values (more specifically, values in the current time supporting leg coordinate 
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system converted from the final states of the last time desired gait) of the total center-of-gravity vertical position and 
velocity are substituted for the initial total center-of-gravity vertical position and velocity in the formulas c13 and c41 , 
thereby determining the floor reaction force's vertical component pattern (more specifically, parameter values) for the 
current time gait so that the formulas c1 3 and c41 are satisfied. Here, the integral values in the formulas d 3 and c41 
5 are the integral values for the period from the start to the end of the current time gait. 

final total center-of-gravity vertical velocity - initial 
10 total center-of-gravity vertical velocity 

= first order integral of (floor reaction force's vertical 
component/mass of the robot) 

15 

+ first order integral of the gravitational acceleration formula c41 



[0370] Here, the gravitational acceleration is a negative value. 

[0371] More specifically, first, assuming that at least two parameters of the floor reaction force's vertical component 
20 parameters (times of apexes or the like) that define the floor reaction force's vertical component pattern as shown in 
Figure 6 are unknown variables, the value of the unknown variables are determined by solving the simultaneous equa- 
tions comprising the formulas c13 and c41 . 

[0372] As the floor reaction force's vertical component parameters assumed to be unknown variables, the height 
(peak value of the floor reaction force's vertical component) and the width (duration of the one leg supporting period) 

25 of the trapezoid in Figure 6 may be adopted. In this case, the gradients of the sides of the trapezoid in Figure 6 are 
set to values predetermined in accordance with the period of the current time gait or the like, or the times of the apexes 
of the floor reaction force's vertical component pattern excluding the time of shifting from the one leg supporting period 
to the floating period occurs are set to values predetermined in accordance with the period of the current time gait or 
the like. Incidentally, if there is only one unknown variable, in general, there is no solution that satisfies the formulas 

30 c13andc41. 

[0373] Then, the process proceeds to step S608, where the floor reaction force's horizontal component allowable 
range [Fxmin, Fxmax] for the simplifiedmodel gait (specifically, parameters for defining the pattern of the floor reaction 
force's horizontal component allowable range) is determined in the same manner as the first and second turning gaits 
of the normal gait. For example, the floor reaction force's horizontal component allowable range having a pattern shown 

35 in Figure 34 is set. In this embodiment, the floor reaction force's horizontal component allowable range is set based 
on the formula c12 in accordance with the floor reaction force's vertical component pattern previously determined in 
step S606. Here, the floor reaction force's horizontal component allowable range for the simplified model gait deter- 
mined in this step may exceed the friction force limit as with the floor reaction force's horizontal component allowable 
range determined previously when generating the normal gait. This is because the floor reaction force horizontal com- 

40 ponent is to be limited by the floor reaction force's horizontal component allowable range for gait correction in full model 
correction described later. 

[0374] Then, the process proceeds to step S610, where the ZMP trajectory for the current time gait (specifically, 
parameters defining the ZMP trajectory, such as times or positions of the apexes of the trajectory) is set as shown in 
Figure 7 to have a high stability margin and not to change abruptly, as with the first and second turning gaits of the 

45 normal gait. The parameters are set in such a manner that the ZMP trajectory for the current time gait is seamlessly 
connected to the ZMP trajectory for the normal gait. That is, the ZMP trajectory parameters are determined in such a 
manner that the position of the ZMP at the end of the current time gait agrees with the ZMP position at the start of the 
normal gait. In this case, for the running gait, the times or positions of the apexes of the ZMP trajectory in the one leg 
supporting period may be set in the same manner as the ZMP trajectory parameters for the normal gait described 

so above. And, the ZMP trajectory parameters are set in such a manner that the desired ZMP trajectory in the floatingperiod 
linearly continuously change from the start of the floating period to the ZMP position at the start of the normal gait. 
[0375] Here, the ZMP trajectory parameters for the current time gait determined in step S610 are provisional ones 
and to be corrected as described later. Thus, the ZMP trajectory for the current time gait thus set is referred to as a 
provisional desired ZMP trajectory for the current time gait hereinafter. 

55 [0376] Finally, the process proceeds to step S612, where a body posture angle restoring period [Ta, Tb] is set. The 
body posture angle restoring start time Ta corresponds to the time Tm in the second turning gait of the normal gait, 
and the body posture angle restoring end time Tb corresponds to the time Ts2 in the second turning gait of the normal 
gait. These times Ta and Tb are set in the same manner as the times Tm and Ts2, respectively. 
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[0377] Returning to Figure 13, after the processing of step S026 (processing of determining the gait parameters for 
the current time gait) is performed as described above, the process proceeds to step S028, where the gait parameters 
for the current time gait (ZMP trajectory parameters) are corrected. In this processing, the ZMP trajectory parameters 
are corrected to make the body position/posture trajectory continuous with the normal gait or bring the same close to 
the normal gait. 

[0378] Figure 35 is a subroutine flowchart showing the processing. 

[0379] FirsL the process proceeds to step S702 via step S700, where based on the provisional desired ZMP pattern 
and the other current time gait parameters, a provisional current time gait to the end time of the current time gait is 
provisionally generated. 

[0380] In step S702 ; a process described below is conducted in accordance with the flowchart shown in Figure 36. 
[0381] tn step S800, various initializations are performed. Specifically, 0 is substituted for the provisional gait gen- 
eration time k. In addition, values in the current time supporting leg coordinate system converted from the final states 
of the last time desired gait (more specifically, final values of the gait states including the body horizontal position/ 
velocity, the body vertical position/velocity, the body posture angle and the angular velocity, and the desired foot position/ 
posture and the arm desired posture) are used as the current time gait's initial states. 

[0382] Then , in step S804 after step S802 , it is determined whether the provisional gait generation time k precedes 
the end time Tcurr of the current time gait or not (whether k < Tcurr). If the result of the determination is YES, the 
process proceeds to a current time gait instantaneous value determination subroutine of step S806, where instanta- 
neous values for the current gait at the time k are determined. Then, the process proceeds to step S808, where the 
provisional gait generation time k is incremented by Ak, and then, the process returns to step S804. 
[0383] If the result of the determination in step S804 is NO, the process shown in the flowchart in Figure 36 is 
completed. 

[0384] By the process described above, the provisional current gait is generated from the start to the end thereof. 
[0385] In the gait instantaneous value determination subroutine in step S806, the process shown in Figure 37 is 
performed. This process will be described below. 

[0386] First, in step S900, based on the floor reaction force's vertical component trajectory parameters of the current 
time gait parameters, the value (current time value) of the desired floor reaction force's vertical component at the time 
k shown in Figure 6 is determined. Then, in step S902, based on the ZMP trajectory parameters of the current time 
gait parameters, the value (current time value) of the desired ZMP trajectory (provisional desired ZMP trajectory) at 
the time k shown in Figure 7 is determined. 

[0387] Then, the process proceeds to step S904, where based on the current time gait parameters (the foot trajectory 
parameters, the reference body posture trajectory parameters andthearmposturetrajectoryparameters), thevalues (cur- 
rent time values) of the desired feet positions/postures, the reference body posture and the desired arm posture at the 
time k are determined. However, as for the desired arm posture, while the total arm center-of-gravity position is deter- 
mined, the degree of freedom of the movement that involves a change of angular momentum about the vertical axis 
(or the body trunk axis) is not determined yet. As in the normal gait, the desired foot position/posture trajectory and 
the floor reaction force's vertical component trajectory for the current time gait are independently determined in ac- 
cordance with the foot trajectory parameters and the floor reaction force's vertical component trajectory parameters 
determined in the flowchart in Figure 33, respectively. 

[0388] Then, the process proceeds to step S906, where the total center-of-gravity vertical position at the time k that 
provides the current time value of the desired floor reaction force's vertical component determined in step S900 (i.e., 
brings the sum of the vertical inertial force of the robot 1 and gravity into balance with the desired floor reaction force's 
vertical component) is calculated. Specifically, this calculation is performed in the same manner as the processing in 
step S406 in Figure 22. 

[0389] Then, the process proceeds to step S908, where the current time value of the body vertical position that 
provides the total center-of-gravity vertical position thus determined is calculated. Specifically, this calculation is per- 
formed in the same manner as the processing in step S408 in Figure 22. 

[0390] Then, the process proceeds to step S910, where based on the parameters of the floor reaction force's hori- 
zontal component allowable range determined in step S608 in Figure 33, the value (current time value) of the floor 
reaction force's horizontal component allowable range [Fxmin, Fxmax] at the time k shown in Figure 34 is determined. 
[0391] Then, the process proceeds to step S912, where the body horizontal acceleration and the body posture an- 
gular acceleration for the current time provisional gait are determined so as to satisfy the desired ZMP (that is, the 
horizontal component of the moment about the desired ZMP is 0). However, these acceleration are determined in such 
a mannerthat the floor reaction force's horizontal component Fx doesn't exceed the range [Fxmin , Fxmax], This process 
is slightly different from the process shown in the flowchart in Figure 23, which illustrates the processing in step S412 
in Figure 22 in detail. 

[0392] Specifically, in step S912, the process shown in Figure 38 is performed. In the flowchart shown in Figure 38, 
first in step S1000, it is determined whether or not the time k lies within the body posture angle restoring period [Ta, 
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Tb] determined in step S612 in Figure 33. 

[0393] If the result of the determination is NO (the floor reaction force's horizontal component allowable range is 0 
or narrow) , the processings from step S1002 to step S1014 are performed. The processings from step S1002 to step 
S 1 01 4 are the same as the processings from step S504 to step S51 6 in Figure 23 described above : and thus, description 
5 thereof is omitted. 

[0394] If the result of the deLermination in step S1000 is YES. Lhe process proceeds to step S1016, where the body 
posture restoring moment ZMP-converted value paLLern ZMPrec is set. in this case, unlike step S518 in Figure 23 
concerning the normal gait generation, ZMPrec is set to a pattern of a constant value of 0 (that is, the height of the 
trapezoidal pattern shown in Figure 27 is 0). Then, the processings from step S 101 8 to step S1026 are performed. 

10 The processings from step S1018 to step S1026 are the same as the processings from step S520 to step S528 in 
Figure 23 described above, and thus, description thereof is omitted. In the processings from step S1 01 6 to step S1 026, 
the instantaneous value of the body posture restoring moment ZMP-converted value ZMPrec is always 0, and therefore, 
the body posture angular acceleration p for the body rotation mode determined in step S1020 is also 0. Therefore, 
assuming that p - 0, only the processings in steps S1022, S1024 and S1026 may be performed. If the result of the 

15 determination in step S1000 is YES, that is. during the body posture angle restoring period [Ta, Tb], p is 0 (p = 0) as 
described above. Therefore, in step S912, in a period other than the body posture angle restoring period [Ta, Tb] (that 
is, a period in which the floor reaction force's horizontal component allowable range is wide enough), a movement 
trajectory for body posture change in the direction for restoring the body posture angular velocity is not generated, 
unlike the case of normal gait generation. 

20 [0395] In this embodiment, since the reference body posture is the vertical posture, and the body posture angular 
acceleration depending on the reference body posture is 0, the angular acceleration p for the body rotation mode 
determined as described above is regarded as the body posture angular acceleration determined in the processing in 
step S912. However, if the reference body posture trajectory parameters are set in such a manner that the reference 
body posture varies, the sum of the angular acceleration p for the body rotation mode determined as described above 

25 and the reference body posture angular acceleration should be regarded as the body posture angular acceleration 
determined in the processing of step S912. 

[0396] Once the processing in step S912 in Figure 37 is completed as described above, the process proceeds to 
step S914, where the body horizontal velocity is determined by integrating the body horizontal acceleration determined 
in step S91 2 (cumulatively summing the body horizontal acceleration values from the start of the current time gait (time 

30 k = 0) to the present time k), and the body horizontal position (current time value) is determined by integrating the body 
horizontal velocity (cumulatively summing the body horizontal velocity values from the start of the current time gait 
(time k = 0) to the present time k). In addition, the body posture angular velocity is determined by integrating the body 
posture angular acceleration determined in step S912 (cumulatively summing the body posture angular acceleration 
values from the start of the current time gait (time k = 0) to the present time k), and the current time value of the body 

35 posture angle is determined by integrating the body posture angular velocity (cumulatively summing the body posture 
angular velocity values from the start of the current time gait (time k - 0) to the present time k). The processing in step 
S914 is the same as the processing in step S414 in Figure 22. 

[0397] After the current time gait instantaneous value determination subroutine of step S806 in Figure 36 is conducted 
as described above, the process proceeds to step S808, where the value of the gait generation time k is incremented 
40 by the gait generation interval Ak. Then, the process returns to step S804, and as far as the condition shown in step 
S804 is satisfied, the processings of steps S806 and S808 are repeated. Then, if the condition shown in step S804 is 
not satisfied, that is, if the provisional current time gait is generated to the end thereof, the process proceeds to step 
S704 in Figure 35. 

[0398] In step S704. from the body horizontal position/velocity (Xe, Vxe) at the end of the current time gait determined 
45 jn step S702 as described above, the final divergence component qO[k] (k = Tcurr) is determined using the formula 
shown in the drawing (formula 10). 

[0399] Then, the process proceeds to step S706, where a final divergence component error errq, which is the differ- 
ence between the current time gaifs final divergence component q0[k] and the normal gait's initial divergence compo- 
nent q" (determined in stepS224 in Figure 20), is determined using the formula shown in the drawing. Then, the process 
50 proceeds to step 708, where it is determined whether the final divergence component error errq thus determined falls 
within an allowable range (a range in the vicinity of 0) or not. 

[0400] If the result of the determination in step S708 is NO, the process proceeds to step S710, where, assuming 
that a = Aa (Aa is a predetermined small amount), based on a desired ZM P obtained by correcting the current provisional 
desired ZMP pattern to be trapezoidal in accordance with the relationship shown in Figure 39, the provisional current 
55 time gait to the end thereof is calculated in the same manner as in step S702. Here, with reference to Figure 39, "a" 
denotes the height of the trapezoidal pattern for correcting the provisional desired ZMP to make the current time gait's 
final divergence component agree with the normal gait's initial divergence component as closely as possible (bring the 
body horizontal position/posture trajectory for the current time gait close to the body horizontal position/posture trajec- 
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tory for the normal gait). In this case, in this embodiment, the correction of the provisional desired ZMP is performed 
during a period in which substantially the whole surface of the sole of the supporting leg's foot 22 (whole sole contact 
period), that is, during a period in which the floor reaction force's horizontal component allowable range is sufficiently 
wide, and the times of the apexes of the trapezoidal pattern are set to the times of the apexes of the provisional desired 
5 ZMP pattern in the whole sole contact period. The assumption that a - Aa in step S710 is intended for observing a 
change of the final divergence component error errq occurring when the current provisional desired ZMP trajectory is 
corrected by a small amount using the trapezoidal pattern. 

[0401] After the provisional current time gait obtained when the provisional desired ZMP trajectory is corrected on 
the assumption that a = Aa is generated to the end thereof in step S710, the process proceeds to step S712, where 
10 based on the body horizontal position/velocity (Xe1 . Vxe1) at the end of the provisional current time gait, the final 
divergence component q1[k] for the provisional current time gait is determined using the formula shown in the drawing 
(formula d 0). 

[0402] In this embodiment, Aa is assumed to be an appropriately set small constant in step S71 0. However, Aa may 
be set to decrease as the final divergence component error errq decreases through repeated calculations described 
15 below. However if Aa is a constant, the final divergence component error errq can be made to fall within the allowable 
range by several repeated calculations. 

[0403] Then, the process proceeds to step S714, where a parameter sensitivity r (rate of change of the final diver- 
gence component error with respect to Aa) is determined using the formula shown in the drawing. Then, the process 
proceeds to step S716, where a correction quantity in a trapezoidal pattern having a height of a ( = -errq/r, which is a 
20 value obtained by dividing the final divergence component error errq determined in step S706 by the parameter sen- 
sitivity r determined in step S714) is added to the provisional desired ZMP pattern in accordance with the relationship 
shown in Figure 39, thereby correcting the provisional desired ZMP pattern (determining a new provisional desired 
ZMP pattern). 

[0404] Then, the process returns to step S702. Then, as far as the result of the determination in step S708 is NO, 
25 the processings from steps S702 to S71 6 are repeated, and if the result of the determination in step S708 is YES, the 
repetition loop (step S700) is exited, and the process proceeds to step S718. 

[0405] In step S718. based orrthe difference between the final body posture angle for the provisional current time 
gait and the initial body posture angle for the normal gait, the difference between the final body posture angular velocity 
for the current time gait and the initial body posture angular velocity for the normal gait or the like, a pattern of the body 
30 posture restoring moment ZM P-converted value (ZMPrec) for the current time gait is determined in such a manner that 
the body posture angle for the current time gait is brought close to the body posture angle for the normal gait. ZMPrec 
determined in this step is used for correcting the provisional desired ZMP to maintain the agreement between the 
current time gait's final divergence component and the normal gait's initial divergence component (condition in step 
S708) even if a body posture angular acceleration is produced so as to connect the body posture angle trajectory to 
the normal gait (bring the body posture angle trajectory close to the normal gait) during a period in which the floor 
reaction force's horizontal component allowable range is sufficiently wide (a period in the one leg supporting period) 
in the processing of generating the current time gait instantaneous values described later. 

[0406] ZMPrec has a trapezoidal pattern as with that described concerning the normal gait generation process and, 
specifically, is determined in the following manner. That is, assuming that, in the trapezoidal pattern of ZMPrec shown 
in Figure 27, the times of the apexes (folds) of the trapezoid are known (specifically, the times of the apexes of the 
trapezoid are adjusted to the times of apexes of the desired ZMP) and the height of the trapezoid is unknown, the 
height (parameter) of trapezoid of ZMPrec is determined as described below. However, concerning step S718, the 
times Tm and Ts2 in Figure 27 are replaced with the times Ta and Tb f respectively. 

[0407] If the body posture restoring moment ZMP-converted pattern has only one unknown parameter as described 
above, in general, both of the body posture angle and the body posture angular velocity of the current time gait cannot 
be seamlessly connected to those of the normal gait at the end of the current time gait. Thus, in this embodiment, the 
unknown parameter is determined in such a manner that the state of the generated gait is gradually brought close to 
the state of the normal gait through plural steps. 

[0408] Incidentally, both of the body posture angle and the body posture angular velocity of the current time gait may 
be connected to those of the normal gait at the end of the current time gait under the conditions that the ZMPrec pattern 
for one gait is more complicated and two or more unknown parameters are used. However, in such a case, there is a 
possibility that the ZMPrec pattern varies too largely in a zigzag. 

[0409] In the following, a calculation principle will be described, and then, a calculation procedure will be described. 
[0410] The difference between the final body posture angle for the provisional current time gait determined as de- 
scribed above on the assumption that the height of the trapezoidal ZMPrec pattern is 0 in step S702 and the initial 
body posture angle for the normal gait, and the difference is denoted by Gerr. In addition, the difference between the 
final body posture angular velocity for the provisional current time gait and the initial body posture angular velocity for 
the normal gait is determined, and the difference is denoted by veerr. 
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[041 1 ] Here, it is assumed that the current time gait is generated on the assumption that the height of the trapezoidal 
ZMPrec pattern is a certain value bcurr, and subsequently, the first turning gait is generated by the same algorithm as 
the current time gait. Here, it is assumed that the pattern of the body posture restoring moment ZMP-converted value 
ZMPrec for the first turning gait is expressed by a sum of the ZMPrec pattern for the first turning gait determined in 
step S518 in Figure 23 (trapezoidal pattern having a height of acyd shown in Figure 27) and a certain value b1 . 
[0412] The gait thus generated is referred to as a ZMPrec-correcLed gail. and the final body posture angle and the 
final angular velocity (at the end of the first turning gait) are denoted by 61 and v61 , respectively. 
[0413] The body posture angle and the angular velocity at the end of the first turning gait of the original normal gait 
determined when the subroutine for determining the initial states of the normal gait in step S024 are denoted by 61 org 
and v01org : respectively (the original normal gait is one determined on the assumption that the initial body posture 
angle and the initial angular velocity for the normal gait determined by the formulas c30 and c31 in step S310 are used 
as initial values, and the pattern determined in step S518 (trapezoidal pattern having a height of acyd in Figure 27) 
is used as the ZMPrec pattern). 
[0414] Here, AG1 and Av61 are defined as follows. 

AB1 =61 - 01 org formula c50 



Av61 =v61 -v61org formula c61 

[0415] A61 and Av61 represent differences in body posture angle and angular velocity, respectively, between the 
ZMPrec-corrected gaitandthe original normal gait at the time when the first turning gait is generatedto the end thereof. 
If A61 and Av6 are 0, when the second turning gait is generated subsequently to the ZMPrec-corrected gait by the 
same algorithm as the current time gait on the assumption that the height of the trapezoidal ZMPrec pattern is acyc2, 
the generated gait agrees with the original normal gait. 

[0416] Therefore, a current time gait's trapezoidal pattern height bcurr and a first turning gaifs trapezoidal pattern 
height b1 are determined so that A01 and Av61 are 0, and the determined value bcurr is used finally as the trapezoidal 
pattern height for the current time gait. 

[0417] Since the dynamics model concerning the body posture angle of the robot 1 has a linearity similar to that of 
the flywheel FH as shown in Figure 11 , A61 and Ave are related as follows with the current time gait's trapezoidal 
pattern height bcurr, the first turning gait's trapezoidal pattern height b1, the difference 6err between the final body 
posture angle for the provisional current time gait and the initial body posture angle forthe normal gait, and the difference 
v6err between the final body posture angle for the provisional current time gait and the initial body posture angular 
velocity for the normal gait. 

A61 = c11 * bcurr + c12 * b1 + 6err + e1 * vGerr formula c52 



AvG1 = c21 * bcurr -f c22 * b1 + e2 * v6err formula c53 

Here ; c11 , c12, c21 , c22, e1 and e2 are coefficients that are uniquely determined by the gait periods of the current 
time gait and the first turning gait, parameters of the pattern of the body posture restoring moment ZMP-converted 
value ZMPrec (in particular, parameters concerning time), or the like. 

[0418] Based on the principle described above, in the calculation procedure, the body posture angle difference Oerr 
and the angular velocity difference VGerr at the boundary between the provisional current time gait and the normal gait 
are first determined. 

[0419] Then, the coefficients c11, c12, c21, c22, e1 and e2 of the formulas c52 and c53 are determined based on 
the gait periods of the current time gait and the first turning gait, parameters of the pattern of the body posture restoring 
moment ZMP-converted value ZMPrec (in particular, parameters concerning time), or the like. 

[0420] Then, the current time gait's trapezoidal pattern height bcurr and the first turning gait 1 s trapezoidal pattern 
height b1 are determined in such a manner that the right sides of the formulas c52 and c53 are 0. That is, the simul- 
taneous equations of the formulas c52 and c53 with the right sides being 0 are solved to determine the values bcurr 
and b1 . 

[0421] Finally, the height of the trapezoidal pattern of the body posture restoring moment ZMP-converted value (ZM- 
Prec) for the current time gait is set to the determined current time gait's trapezoidal pattern height bcurr. 
[0422] Then, the process proceeds to step S720, where as a desired ZMP pattern forthe current time gait, a pattern 
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is determined which is a sum of the current provisional desired ZMP pattern (provisional desired ZMP pattern when 
the repetition loop in step S700 is exited) and the body posture restoring moment ZMP -con verted value pattern deter- 
mined as described above in step S718. This processing is the same as the processing of adding the trapezoidal 
pattern having a height of Aa to the provisional desired ZMP pattern in step S71 0. 
5 [0423] A reason why the body posture restoring moment ZMP-converted value pattern is added to the provisional 
desired ZMP pattern will be described below. 

[0424] The provisional current. Lime gait generated in the loop in step S700 is generated on the assumption thai the 
body posture restoring moment ZMP-converted value ZMPrec is 0 (the height parameter of the trapezoidal ZMPrec 
pattern is 0) as described above. For the provisional current time gait thus finally generated in the loop in step S700, 
10 while the body position/velocity is continuous to or close to that for the normal gait, the body posture angle is shifted 
from the body posture angle for the normal gait or possibly diverges. 

[0425] The body posture restoring moment ZMP-converted value pattern determined in step S718 is one that pro- 
duces such a body posture angular acceleration that brings the shift of the body posture angle from that for the normal 
gait close to 0. 

15 [0426] However, if the body posture angular acceleration according to the body posture restoring moment ZMP- 
converted value pattern determined in step S718 is produced without correcting the provisional desired ZMP pattern 
resulting from the loop in step S700 ; the body horizontal position trajectory has to be shifted from the body horizontal 
position trajectory for the provisional current time gait in order to satisfy the dynamical equilibrium condition (that the 
moments applied to the desired ZMP by the resultant force of gravity and the inertial force of the robot, except for the 

20 vertical moment, are 0). Thus, in this embodiment, the provisional desired ZMP pattern is corrected so that there is no 
need to shift the body horizontal position trajectory from that resulting from the loop in step S700 
[0427] If, besides the movement according to the provisional current time gait, the body posture angular acceleration 
according to the body posture restoring moment ZMP-converted value pattern determined in step S718 is produced, 
the ZMP (a point where the moments caused by gravity and the inertia! force caused by a movement, except for the 

25 vertical moment, are 0) is shifted by the body posture restoring moment ZMP-converted value. Therefore, if a pattern 
which is a sum of the provisional desired ZMP pattern and the body posture restoring moment ZMP-converted pattern 
is used as a desired ZMP pattern, and a current time gait that satisfies the desired ZMP pattern is generated while 
producing a body posture angular acceleration for the body rotation mode associated with the body posture restoring 
moment ZMP-converted value pattern determined in step S718, a body translation movement similar to the provisional 

30 current time gait is provided. 

[0428] Above described is a reason why the sum of the body posture restoring moment ZMP-converted value pattern 
and the provisional desired ZMP pattern is used as the desired ZMP pattern. 

[0429] Returning to Figure 13, after correcting the current time gait parameters in step S208 as described above, 
the process proceeds to step S030, where parameters defining the floor reaction force's horizontal component allowable 

35 range and the ZMP allowable range for gait correction are determined. In this case, the floor reaction force's horizontal 
component allowable range for gait correction is set to have the pattern shown in Figure 34 for the X axis direction 
(back-and-forth direction) and the Y axis direction (sideward direction) based on the floor reaction force's vertical com- 
ponent trajectory and the formula d 2, as with the floor reaction force's horizontal component for the simplified model 
gait, for example. And, for example, the value of ka*u.> in the formula ct2 is set as a parameter that defines the floor 

40 reaction force's horizontal component allowable range for gait correction. However, it is preferably that the f ioor reaction 
force's horizontal component allowable range is reliably set within the friction limit by setting the coefficient ka in the 
formula c12 to a value smaller than the floor reaction force's horizontal component allowable range for the simplified 
model gait, for example. 

[0430] In addition, as described in detail later, the ZMP allowable range is determined in accordance with the sup- 
45 porting polygon that is determined by the feet position/posture trajectory. Basically, the ZMP allowable range is set to 
a rectangular region in the supporting polygon (region in the XY plane), and as parameters that define the ZMP allowable 
range, the end values thereof in the X axis direction and the end values thereof in the Y axis direction are set, for 
example. The ZMP allowable range for the running gait is set within the contact surface of the supporting leg's foot 22 
during the one leg supporting period and set within a range having no width in both the X and Y axis directions (that 
50 is, a point) during the floating period (for example, the desired ZMP itself is regarded as the ZMP allowable range). 
[0431] After the processing in step S030 is performed, or if the result of the determination in step S016 is NO, the 
process proceeds to step S032, where current time gait's instantaneous values (values at the present time t) are 
determined using the simplified model. 

[0432] In step S032, the same processings as those in steps S900 to S910 in Figure 37 are performed, and then, 
55 the processings in steps S1000 to S1026 in Figure 38, which is the subroutine of step S912, are performed. In this 
case, however, in step S1016 in Figure 38, the body posture restoring moment ZMP-converted value (ZMPrec) pattern 
is not set to 0 but to be the body posture restoring moment ZMP-converted value (ZMPrec) pattern set in step S718 
in Figure 35. Then, the same processing as that in step S914 in Figure 37 is performed, and the process in step S032 
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in Figure 13 is completed. 

[0433] Then ; the process proceeds to step S034 ; where an arm movement that cancels the spinning force (that 
allows the floor reaction force's vertical moment caused about the desired ZMP by movements of parts, other than the 
arms, of the robot 1 to be substantially 0) is determined, Specifically, the floor reaction force moment's vertical com- 

5 ponent trajectory in the desired ZM P in the case where the arms don't swing is determined. More strictly, values obtained 
by inverting the signs of the instantaneous values of the vertical component trajectory of the moment applied to the 
desired ZMP by the resultant force of gravity and the inertia! force of the robot in the case where the gait is generated 
without the arms swinging are determined. That is, an instantaneous value is determined for the floor reaction force 
moment vertical component about the desired ZMP (instantaneous value) in balance with the instantaneous value of 

10 the movement according to the gait generated in the processing in step S032 (excluding the arm swing movement). 
Then, the instantaneous value is divided by the equivalent moment of inertia the arm swing movement, thereby deter- 
mining the angular acceleration of the arm swing movement required for canceling the spinning force. Incidentally, a 
too wide arm swing can be addressed by dividing the instantaneous value by a value larger than the equivalent moment 
of inertia. 

15 [0434] Then, the angular acceleration is integrated two times, the resulting value is passed through a low cut filter 
for preventing the integral value from being too large and the resulting angle is regarded as an arm swing movement 
angle. However in the arm swing movement the left and right arms are swung oppositely in the back-and-forth direction 
to prevent the center of gravity of the arms from varying. An arm swing movement for canceling the spinning force may 
be generated for the normal gait, and the arm swing movement for the current time gait be determined so as to connect 

20 to the arm swing movement. 

[0435] The instantaneous values at the present time t generated by the process up to step S034 described above 
will be referred to as simplified model gait's instantaneous values, hereinafter. In this embodiment, the simplifiedmodel 
gait's instantaneous values are determined using the simplifiedmodel (dynamics model shown in Figure 11) in such a 
manner that the floor reaction force moment caused about the desired ZMP by the resultant force of the inertial force 

25 and gravity caused by movement of the robot 1 is 0 (the dynamical equilibrium condition concerning the desired ZMP 
is satisfied). Therefore, the simplified model gait in this embodiment is equivalent to the desired gait according to the 
definition (b'). 

[0436] In this case, of the simplifiedmodel gait' s instantaneous values, the instantaneous values of the body position/ 
posture and the body vertical position are provisional ones, which are to be corrected by full model correction described 
30 later. In addition, of the simplified model gait's instantaneous values in this embodiment, the instantaneous value of 
the floor reaction force moment about the desired ZMP is 0, although it is also a provisional one, which is to be corrected 
by full model correction described later. 

[0437] While the running gait shown in Figure 5 is taken as an example in the process of determining the simplified 
model gait's instantaneous values described above, the simplified model gait's instantaneous values can be determined 

35 jn the same manner even in the case of generating a walking gait of the robot 1 . In this case, the floor reaction force' 
s vertical component trajectory (one step of trajectory) may be set to be a polygonal pattern as shown in Figure 40, for 
example. In this example, more specifically, the floor reaction force's vertical component trajectory for the walking gait 
is set to have a trapezoidal shape protruding in the direction of the floor reaction force's vertical component increasing 
(protruding upward) during the two leg supporting period and set to have a trapezoidal shape protruding in the direction 

40 of the floor reaction force's vertical component decreasing (protruding downward) during the one leg supporting period. 
In this case, the heights C.1 and C2 and the like of the two trapezoidal parts of the floor reaction force's vertical com- 
ponent are preferably determined in the following manner. That is, using the body height determination method previ- 
ously proposed by the applicants (in Japanese Patent Laid-Open No. 10-86080, more specifically, the method shown 
in Figure 6 of this document or the like), the body vertical position trajectory that satisfies a predetermined geometrical 

45 condition concerning displacement of the joints (specifically, the knee joints) of the legs 2, 2 of the robot 1 (condition 
for preventing the legs 2, 2 from being fully stretched) is determined as a reference body vertical position trajectory. 
Then, the height C1 and C2 of the two trapezoidal parts of the floor reaction force's vertical component trajectory are 
determined in such a manner that a characteristic quantity concerning the shape of the body vertical position trajectory 
corresponding to the total center-of-gravity vertical position trajectory of the robot 1 obtained by second order integral 

50 of the floor reaction force's vertical component trajectory from the start to the end of the gait (for example, difference 
between the maximum value and the minimum value) agrees with a characteristics quantity of the reference body 
vertical position trajectory (for example, difference between the maximum value and the minimum value). In this case, 
as in setting of the floor reaction force's vertical component trajectory for the running gait, in setting of the floor reaction 
force's vertical component trajectory for the walking gait, the average value of the floor reaction force's vertical com- 

55 ponent for one period thereof is adapted to agree with the weight of the robot 1 . 

[0438] By determining the floor reaction force's vertical component trajectory for the walking gait in this way, appro- 
priate simplified model gait's instantaneous values (in particular, an instantaneous value of the body vertical position) 
that prevent the legs 2, 2 from being fully stretched can be determined. When generating a walking gait, the simplified 
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model gait's instantaneous values can be determined by performing the same process as the process of generating 
the simplified model gait's instantaneous values for the running gait except that the floor reaction force's vertical com- 
ponent trajectory is set as described above. 

[0439] The simplified model gaits instantaneous values for the walking gait may be determined by the method ac- 
5 cording to the first embodiment or the like described in Japanese Patent Laid-Open No. 2000-35201 1 previously pro- 
posed by the applicants. 

[0440] Returning Lo the flowchart in Figure 13, then, the process proceeds to step S036, where, based on the pa- 
rameters that defines the floor reaction force's horizontal component allowable range and the ZMP allowable range 
for gait correction (these parameters are set in step S030) ; the instantaneous values (values at the present time t) of 
10 the floor reaction force's horizontal component allowable range and the ZMP allowable range for gait correction are 
determined. 

[0441] Then, the process proceeds to step S038, where the full model is used to generate a corrected gait (correct 
the gait) , thereby determining the instantaneous values for the final desired gait. That is, as described earlier with 
reference to Figure 8 , calculation (determination) of the corrected desired body position/posture, the corrected desired 

15 floor reaction force moment about the desired ZMP or the like is performed. 

[0442] The gait correction method in step S038 constitutes a principal characteristic of the present invention. Various 
examples of the gait correction method will be explained below, and first, the gait correction method will be outlined. 
[0443] The gait correction methods can be categorized as shown in Figure 41 . This categorization table is substan- 
tially the same as that shown in Figure 12 of Japanese Patent Application No. 2001-133621 previously proposed by 

20 the applicants. However, of the method involving no correction of inputs of the simplified model, the method that doesn't 
use a perturbation model is excluded. This is because this method involves correcting only the floor reaction force to 
satisfy the dynamical equilibrium condition and cannot actually correct a gait, such as a running gait, that may have 
narrow floor reaction force's horizontal component allowable range and ZMP allowable range while preventing these 
allowable ranges from being exceeded. 

25 [0444] A correction method for the device according to the first embodiment is of a full model feed forward type. 
Furthermore, it uses the inverse dynamics full model (inverse full model), does not correct the simplified model gait 
and uses the perturbation model. 

[0445] Figure 42 is a functional block diagram for illustrating an operation of the gait generation device 1 00 according 
to the first embodiment of the present invention, specifically, the gait correction method in step S038 in the flowchart 
30 jn Figure 13. However, a simplified model 200 shown in Figure 42 is not simply a dynamics model but represents the 
process from steps S010 to S034 described above, that is, calculation (determination) of the simplified model gait's 
instantaneous values. Therefore, the sections following the simplified model 200 in Figure 42 are associated with the 
processing in step S038. 

[0446] The process of determining the instantaneous values of the floor reaction force's horizontal component al- 
35 lowable range and the ZMP allowable range for gait correction is denoted by reference numeral S036, which is equiv- 
alent to that in the flowchart in Figure 13. 

[0447] Since the process is actually performed by one computer, the process is performed, after the block diagram 
is digitized, sequentially from the upstream part toward the downstream part (gait output) in the block diagram. However, 
as a feedback quantity returned to the upstream stage, a value (state quantity) calculated during the last time control 
40 cycle (at the time t-At, where t denotes the present time) is used. In the following, the value calculated during the last 
time control cycle (at the time t-At) will be abbreviated as a last time value. 

[0448] Each time the process in step S038 is performed, calculation for one control cycle in the block diagram is 
performed. 

[0449] Incidentally, as a digitization method, a backward difference method, a forward difference method, a bilinear 
45 conversion and the like are known, and any of them can be used. However, for example, if the backward difference 
method is used, calculation of the current time value (output) of a variable may require the current time value (output) 
of the variable itself. Thus, as in the case where when determining a value of y that satisfies the formula y = f (u, y) , 
the formula is transformed to provide an expression of y not using y itself, the block diagram has to be transformed 
into one that clearly shows the input/output relationship. According to the block diagram thus transformed, the process 
50 is performed sequentially from the upstream part toward the downstream part (gait output). 

[0450] In step S038, first, the instantaneous value of the variables (referred to as movement variables) that represent 
the movement, such as the desired body posture angle for the simplified model gait obtained as described above 
(referred to as a simplified model's body posture angle, hereinafter), the desired body horizontal position (referred to 
as a simplified model's horizontal position, hereinafter), the desired center-of-gravity position, the desired foot position/ 
55 posture and the desired arm posture and the instantaneous value of the desired ZMP are input to an inverse dynamics 
full model (inverse full model) 201 . Through a calculation process in the inverse full model 201 , the floor reaction force's 
horizontal component and the floor reaction force moment about the desiredZMP that are in balance with the movement 
represented by the input movement variables (i.e., that are produced by the full model in accordance with the move- 
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merit) are calculated. Since the floor reaction force moment about the desired ZMP in the simplified model gait is 0, 
the floor reaction force moment about the desired ZMP calculated by the inverse full model 201 indicates the error of 
the simplified model gait. The floor reaction force's horizontal component and the floor reaction force moment deter- 
mined by the inverse full model 201 are referred to as "full-model's floor reaction force's horizontal component" and 
5 "full-model's floor reaction force moment", respectively. In addition, the full-model's floor reaction force's horizontal 
componenL is often abbreviated as Ffull and the full-model's floor reaction force moment is often abbreviated as Mfull 
hereinafter. 

[0451] Besides, the inverse full mode! 201 calculates the body vertical position that satisfies the desired center-of- 
gravityposition. In addition, although not shown, the inverse full model 201 calculates the center-of-gravity horizontal 
10 position. 

[0452] Incidentally, since the desired total center-of-gravity vortical position is input to the full model, and the desired 
floor reaction force's vertical component can be derived from the desired total center-of-gravity vertical position by 
second order differentiation thereof, there is no need to input the desired floor reaction force's vertical component to 
the full model. Although redundant, the desired floor reaction force's vertical component may be input to the full model 
15 in order to reduce the calculation amount, for example. 

[0453] Now, a perturbation model used for gait correction will be described. 

[0454] The perturbation model consists of a perturbation model 202 for correcting body hori zontal positions and a 
perturbation model 203 for correcting body posture angles. Alternatively, rather than such two separate models, one 
integral perturbat ion mode! may be used as shown in Figure 11 . 

20 [0455] The perturbation model 202 for correcting body horizontal positions represents a relationship between the 
perturbation of the floor reaction force and the perturbation of the body horizontal position in the body translation mode. 
[0456] The perturbation model 202 for correcting body horizontal positions receives a correction quantity of the de- 
sired floor reaction force moment and calculates a correction quantity of the desired body horizontal position that is in 
balance with the received correction quantity in terms of dynamics. The input (correction quantity of the desired floor 

25 reaction force moment) is referred to as a moment Mp forthe perturbation model forcorrecting body horizontal positions. 
In addition, the output (correction quantity of the desired body horizontal position) of the perturbation model 202 for 
correcting body horizontal positions is referred to as a correcting perturbation model's body horizontal position Xc. In 
addition, the floor reaction force's horizontal component produced by the perturbation model 202 for correcting body 
horizontal positions is referred to as a floor reaction force's horizontal component Fp for the perturbation model for 

30 correcting body horizontal positions. 

[0457] As shown in Figure 43, the perturbation model 202 for correcting body horizontal positions is represented by 
an inverted pendulum consisting a fulcrum, an inverted pendulum material particle (body material particle) and an 
expandable supporting bar that links them to each other. The fulcrum is positioned so that the horizontal position of 
the fulcrum agrees with the horizontal position of the origin of the current time gait's supporting leg coordinate system, 

35 and the vertical position of the fulcrum agrees with the vertical position of the desired ZMP. The mass mb of the inverted 
pendulum material particle is equal to the mass of the body material particle in the simplified model (model consisting 
of three material particles and a flywheel) shown in Figure 1 1 . The vertical position Zc of the inverted pendulum material 
particle is the same as the vertical position Zb of the body material particle in the simplified model for the simplified 
gait shown in Figure 11 . 

40 [0458] The perturbation model 202 for correcting body horizontal positions represents a relationship between a floor 
reaction force moment's perturbation AMy and a body material particle horizontal position's perturbation AXb in the 
dynamical equations a8, a.9 and a1 0 for the simplified model (three-material-particle model). 

[0459] Thus, assuming that the values other than My, Xb and Zb are constants, the relationship between the floor 
reaction force moment's perturbation AMy and the body material particle horizontal position's perturbation AXb is de- 
45 termined from the formula a1 0. Then, the following formula results. 

AMy - -mb*AXb*(g+d2Zb/dt2) + mb*(Zb-Zzmp)*d2AXb/dt2 formula al 2 

50 [0460] Similarly, assuming that the values other than Fx and Xb are constants, the relationship between a floor 
reaction force's horizontal component's perturbation A Fx and the body material particle horizontal position's perturba- 
tion AXb is determined from the formula a9. Then, the following formula results. 

55 AFx = mb*d2AXb/dt2 formula a13 

[0461] Since the body translation mode floor reaction force ratio h, which is a ratio between AMp and AFp caused 
by the body horizontal acceleration, is a ratio between the term caused by the body horizontal acceleration in the right 
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side of the formula a12 (that is, the second term) and the formula a13, the following formula results. 

h = (Zb-Zzmp) formula a14 

5 

[0462] That is, the body translation mode floor reaction force ratio h is equivalent to the height of the bodymaterial 
particle (inverted pendulum material particle) from the fulcrum in the simplified model. 
[0463] Therefore, from the formulas a12 anda14, the following formula results. 

10 

AMy = -mb*AXb*(g+d2Zb/dt2) + mb*h*d2AXb/dt2 

[0464] On the other hand, the floor reaction force's vertical component in balance with the translation force's vertical 
component of the resultant force of gravity and the inertia! force applied to the body material particle (inverted pendulum 
15 material particle) is referred to as a body floor reaction force's vertical component Fbz. The body floor reaction force's 
vertical component Fbz is defined by the following formula. 

Fbz = mb*(g+d2Zb/dt2) formula a1 6 

20 

[0465] From the formula a8, the body floor reaction force's vertical component Fzb can be expressed as the following 
formula. 

25 Fbz = Fz-msup*(g+d2Zsup/dt2) - mswg*(g+d2Zswg/dt2) formula a17 

[0466] In other words, the body floor reaction force's vertical component equals to a sum of the floor reaction force's 
vertical component Fz and the translation force's vertical component of the resultant force of gravity and the inertia! 
force applied to the leg material particles in the simplified model (model consisting three material particles and a fly- 
30 wheel) shown in Figure 11 . 

[0467] Substituting the formula at 6 into the formula a1 5 results in the following formula. 

AMy = -Fbz*AXb + mb*h*d2AXb/dt2 formula a1 8 

35 

[0468] Associating AMy and AXb in the formula a18 with the moment Mp for the perturbation model for correcting 
body horizontal positions and the correcting perturbation model's body horizontal position Xc, respectively, (substituting 
the moment Mp for the perturbation model for correcting body horizontal positions and the correcting perturbation 
model's body horizontal position Xc into AMy and AXb in the formula a1 8, respectively,) results in the following formula. 

40 

Mp - -Fbz*Xc + mb*h*d2Xc/dt2 formula a1 9 

[0469] That is, the perturbation mode! 202 for correcting body horizontal positions is expressed by the formula a19 
45 using the body translation mode floor reaction force ratio h determined by the formula a1 4 and the body floor reaction 
force's vertical component Fbz determined by the formula a1 7. 

[0470] In addition, associating AFx in the formula a13 with the floor reaction force's horizontal component Fp for the 
perturbation model for correcting body horizontal positions results in the following formula. 

50 

Fp = mb*d2Xc/dt2 formula a20 

[0471] That is, the perturbation model 202 for correcting body horizontal positions is described by the formulas a14, 
a17, a19 and a20. 

55 [0472] Incidentally, it is considered that the perturbation of the body material particle position agrees with the per- 
turbation of the body position (position of the representative point of the body) herein. However, strictly speaking, they 
don't always agree with each other actually. Therefore, to determine the relationship among Mp, Fp and Xc, a mode! 
is needed which represents a geometrical relationship between the body material particle horizontal position and the 
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body position. 

[0473] On the other hand, the perturbation model 203 for correcting body posture angles represents a relationship 
between the perturbation of the floor reaction force and the perturbation of the body posture angle in the body rotation 
mode. 

[0474] The perturbation model 203 for correcting body posture angles receives a correction quantity of the floor 
reaction force moment and calculates a correction quantity of the desired body posture angle in balance with the 
received correction quantity in terms of dynamics. The input (correction quantity of the floor reaction force moment) is 
referred to as a moment Mr for the perturbation model for correcting body posture angles. In addition, the output 
(correction quantity of the desired body posture angle) of the perturbation model 203 for correcting body posture angles 
is referred to as a correcting perturbation model's body posture angle 0c. In addition, the floor reaction force's horizontal 
component produced by the perturbation model for correcting body posture angles is referred to as a floor reaction 
force's horizontal component Frforthe perturbation model for correcting body horizontal positions. As described above. 
Fr is 0. That is, the following formula always holds. 

Fr - 0 formula a21 

[0475] The perturbation model 203 for correcting body posture angles is expressed by a flywheel FH as shown in 
Figure 44. The inertia of the flywheel equals to that of the flywheel FH in the simplified model (model consisting of three 
material particles and a flywheel) shown in Figure 1 1 . The rotation angle of the flywheel of the perturbation model 203 
for correcting body posture angles corresponds to the correcting perturbation model's body posture angle 0c, and the 
floor reaction force moment caused by the flywheel corresponds to the moment Mr for the perturbation model for 
correcting body posture angles. 

[0476] The perturbation model 203 for correcting body posture angles represents a relationshipbetween a floor re- 
action force moment's perturbation AMy and a body posture angle's perturbation A0b in the dynamical equation a10 
for the simplified mode! (model consisting three material particles and a flywheel). 

[0477] Thus, assuming that the values other than My and 6b are constants, the relationship between the floor reaction 
force moment's perturbation AMy and the body posture angle's perturbation AGb is determined from the formula a10. 
Then, the following formula results. 

AMy = J*d2A0b/dt2 formula a22 

[0478] Associating AMy and A6b in the formula a22 with the moment Mr for the perturbation model for correcting 
body posture angles and the correcting perturbation model's body posture angle ec, respectively, results in the following 
formula. 

Mr = J*d26c/dt2 formula a23 

[0479] That is, the perturbation model 203 for correcting body posture angles is expressed by the formula a23. In 
addition, as described above, the floor reaction force's horizontal component Frforthe perturbation model for correcting 
body horizontal positions is as shown in the formula a21 (Fr = 0). 

[0480] As described later, in step S038, finally, a corrected gait (more specifically, desired instantaneous values 
obtained by correcting the instantaneous values for a part of the simplified model gait) is generated (output). The 
desired body posture angle for the corrected gait (referred to as a corrected desired body posture angle, hereinafter) 
is obtained by a calculator 204 adding the correcting perturbation model's body posture angle 6c (value determined in 
the control cycle including the present time t) to the instantaneous value of the simplified model's body posture angle 
determined as described above (instantaneous value of the desired body posture angle for the current time gait at the 
present time t determined in step S032). The desired body horizontal position for the corrected gait (referred to as a 
corrected desired body horizontal position, hereinafter) is obtained by a calculator 205 adding the correcting perturba- 
tion model's body horizontal position Xc (value determined in the control cycle including the present time t) to the 
instantaneous value of the simplified model body horizontal position determined as described above (instantaneous 
value of the desired body horizontal position for the current time gait at the present time t determined in step S032). 
[0481] The desired floor reaction force for the corrected gait is also corrected. Specifically, the floor reaction force 
moment's horizontal component about the desired ZMP is not 0, and the corrected desired floor reaction force moment 
is output as a desired value. Therefore, the desired ZMP loses its original meaning (meaning that it is a point where 
the floor reaction force moment's horizontal component is 0). In addition, the desired floor reaction force's horizontal 
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component is also corrected, and the corrected desired floor reaction force's horizontal component is output. 
[0482] As described above, the movement according to the corrected gait is a sum (combination) of the movement 
according to the simplified model gait and the movement according to the perturbation model (specifically, the move- 
ments according to the perturbation model for correcting body positions/postures and the perturbation model for cor- 

5 recting body posture angles). 

[0483] In general the floor reaction force caused by a combination of a reference movement and a perturbation 
movement can be approximated by a sum of the floor reaction force caused by the reference movement (floor reaction 
force in balance with gravity and the inertial force caused by the movement) and the perturbation of the floor reaction 
force caused by the perturbation movement. 

io [0484] Therefore, the floor reaction force causedby the movement according to the corrected gait (strictly, value of 
the floor reaction force caused by the movement according to the corrected gait, calculated using the inverse full model 
201 ) is a sum of the floor reaction force for the inverse full model 201 (value of the floor reaction force caused by the 
movement according to the simplified model gait, calculated using the inverse full model 201), the input moment for 
the perturbation model 202 for correcting body positions/postures (the moment Mp for the perturbation model for cor- 

15 recting body horizontal positions) and the input moment for the perturbation model 203 for correcting body posture 
angles (the moment Mr for the perturbation model for correcting body posture angles). 

[0485] In order for a corrected gait precisely to satisfy the dynamical equilibrium condition, the floor reaction force 
caused by the movement according to the corrected gait (specifically, the floor reaction force produced by the movement 
according to the corrected gait in the inverse full model 201) has to approximately agree with the corrected desired 
20 floor reaction force. Therefore, in order to satisfy the condition, the following two formulas have to be satisfied. 

full model floor reaction force moment Mfull 
25 + moment for the perturbation model for correcting body 

horizontal positions Mp 
+ moment for the perturbation model for correcting body posture 

30 

angles Mr 

= corrected desired floor reaction force moment formula 5 



full model floor reaction force's horizontal component 
Ffull 

4Q + floor reaction force's horizontal component for the 

perturbation model for correcting body horizontal positions 

Fp 

45 

+ floor reaction force's horizontal component for the 
perturbation model for correcting body posture angles Fr 
5Q = corrected desired floor reaction force's horizontal 

component formula 6 

[0486] In addition, the true ZMP for the corrected gait is displaced from the desired ZMP (ideal desired ZMP) for the 
55 simplified model gait by a value obtained by dividing the corrected desired floor reaction force moment by the desired 
floor reaction force's vertical component. 
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true ZMP for the corrected gait ~ desired ZMP 
+ corrected desired floor reaction force moment/desired 

floor reaction force's vertical component formula 7 

[0487] When calculating the x-directional (back-and-forth directional) component of the true ZMP for the corrected 
gait, the component of the corrected desired floor reaction force moment about the Y axis (sideward directional axis) 
10 is used. Besides, when calculating the Y-directional component of the true ZMP for the corrected gait, the component 
of the corrected desired floor reaction force moment about the X axis (back-and-forth directional axis) is used. However 
when calculating the Y-directional component of the true ZM P for the corrected gait, the sign 'V in the right side of the 
formula 7 has to be replaced with the sign 

[0488] The true ZMP for the corrected gait determined from the formula 7 has to lie within the ZMP allowable range. 
15 This is referred to as a ZMP limitation condition. 

[0489] In addition, the corrected desired floor reaction force' s horizontal component has to fall within thef loor reaction 
force's horizontal component allowable range for gait correction . This is referred to as a floor reaction force's horizontal 
component limitation condition. 

[0490] As described above, the corrected gait has to satisfy the formulas 5 and 6. the ZMP limitation condition (con- 
20 dition of the possible range of the true ZMP for the corrected gait determined from the formula 7) and the floor reaction 
force's horizontal component limitation condition. 

[0491] However if the formulas and the conditions is simply satisfied, the correcting perturbation model's body po- 
sition and the correcting perturbation model's body posture angle diverge. 

[0492] Thus, based on the state quantities of the perturbation model 202 for correcting body horizontal positions and 
25 the perturbation model 203 for correcting body posture angles (more specifically, the correcting perturbation model's 
body horizontal position/velocity, the correcting perturbation model's body posture angle, the correcting perturbation 
model body angular velocity or the like) , the correcting perturbation models 202 and 203 are controlled for stabilization 
to make these state quantities converge to predetermined states (be stabilized). 

[0493] First, stabilization control of the perturbation model 202 for correcting body horizontal positions will be de- 
30 scribed in detail. 

[0494] in Japanese Patent Application No. 2001-133621 previously proposed by the applicants, an inverted pendu- 
lum type perturbation model is used, a control law is adopted which makes the position XGf of the center of gravity 
calculated using the full model based on the instantaneous posture in the corrected gait converge to position XGs of 
the center of gravity calculated using the simplified model based on the instantaneous posture in the simplifiedmodel, 
35 and the feedback quantity (fed-back manipulating quantity) determined by the control law is additionally input to the 
perturbation model for correcting body horizontal positions. 

[0495] Specifically, the control law represented by the formula 9 is given so that convergence to the desired settling 
position represented by the formula 8 is provided. In these formulas, "mtotal" denotes the total weight of the robot, 
"mb" denotes the mass of the body material particle (mass of the inverted pendulum), and "XGf denotes the position 
40 of the center of gravity calculated using the full model based on the instantaneous posture in the simplified model gait, 
that is, the horizontal position of the center of gravity calculated using the inverse full model. In addition, "Kp" and "Kv" 
denote gains of feedback control. 

45 desired settling position = -mtotal/mb*(XGf - XGs) 

ZMP-con verted value of the feedback quantity for the 
perturbation model for correcting body horizontal positions 
= Kp * (correcting perturbation model's body horizontal 
position - desired settling position) 
i Kv*correcting perturbation model's body horizontal velocity 
+ correcting perturbation model's body horizontal position formula 9 



50 



55 
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[0496] Incidentally., in actual calculation by a computer the last time values are used for the variables in the right 
side of the formula. This holds true for the control laws described below. 

[0497] The perturbation model for correcting body horizontal positions used in the full model correction method pro- 
posed in this specification by the applicants is similar to the perturbation model for correcting body horizontal positions 
5 used in Japanese Patent Application No. 2001-133621 previously proposed by the applicants in that it is an inverted 
pendulum type model, although it has a strong nonlinearity. 

[0498] Thus, also in the full model correction method proposed in this specification, the desired settling position is 
determined in the same manner, and only the control law for convergence to the desired settling position is altered. 
[0499] The control law for converging (stabilizing) the perturbation model 202 for correcting body horizontal positions 

10 to the desired settling position is referred to as a control Iaw206forthe perturbation model for correcting body horizontal 
positions, and the feedback quantity (manipulating quantity) determined by the control law is referred to as a required 
value Mpfdmd of the moment for stabilizing the perturbation model for correcting body horizontal positions. The term 
"required value" means that the value determined by the control law is limited and corrected so that the true ZMP lies 
within the ZMP allowable range and the floor reaction force's horizontal component falls within the floor reaction force's 

15 horizontal component allowable range, as described later. The moment limited and corrected is referred to as a moment 
Mpf for stabilizing the perturbation model for correcting body horizontal positions. 

[0500] As the control law 206 for the perturbation model for correcting body horizontal positions ; the following formula 
may be used instead of the formula 9. 

20 

required value Mpfdmd of the moment for stabilizing the 
perturbation model for correcting body horizontal positions 
25 - Kpp * (correcting perturbation model's body horizontal . 

position Xc - desired settling position) 
+ Kpv * correcting perturbation model's body horizontal 

30 

velocity dXc/dt 
- correcting perturbation model's body horizontal position 
35 Xc * body floor reaction force's vertical component Fbz formula 1 0 

In the formula, "Kpp" and "Kpv" denote gains of feedback control. 

[0501] As described concerning the perturbation model 202 for correcting body horizontal positions, the body floor 
reaction force's vertical component Fbz is applied to the body material particle (inverted pendulum material particle) 
40 in the vertical direction. Therefore, if the body material particle is displaced from the origin (position of the fulcrum), a 
moment that promotes the displacement is further applied to the body material particle. The third term in the right side 
of the formula 1 0 represents the moment for canceling this effect. 

[0502] When determining the component about the X axis (back-and-forth directional axis) of the required value 
Mpfdmd of the moment for stabilizing the perturbation model for correcting body horizontal positions, the Y axis direc- 
ts tional (sideward directional) components of the correcting perturbation model's body horizontal position/velocity and 
the desired settling position are used. 

[0503] When determining the component about the Y axis (sideward directional axis) of the required value Mpfdmd 
of the moment for stabilizing the perturbation model for correcting body horizontal positions, the X axis directional 
(back-and-forth directional) components of the correcting perturbation model's body horizontal position/velocity and 

so the desired settling position are used, and the sign "-" of the third term in the right side is replaced with the sign "+". 
[0504] The desired settling position may be 0 (horizontal position of the fulcrum of the inverted pendulum). In addition, 
the control law 206 forthe perturbation model for correcting body horizontal positions may be any of the various methods 
described in Japanese Patent Application No. 2001-133621 previously proposed by the applicants. Besides them, the 
control law 206 for stabilizing the perturbation model for correcting body horizontal positions may be determined in 

55 such a manner that at least any of the state quantities of the perturbation model 202 for correcting body horizontal 
positions (more specifically, the correcting perturbation model's body horizontal position/velocity or the like) converges 
(is stabilized) to a predetermined state. 

[0505] Now, stabilization control of the perturbation model 203 for correcting body posture angles will be described 
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in detail. 

[0506] In order for the corrected desired body posture angle, that is, the sum of the desired body posture angle 
according to the simplifiedmodel and the correcting perturbation model's body posture angle to be settled to, or follow, 
the reference body posture angle (determined in step S904 in Figure 37) output by the desired instantaneous value 

5 generator 1 00b or the desired body posture angle according to the simplified model (determined in step S91 4 in Figure 
37), the feedback quantity (manipulating quantity) is determined by a feedback control law, such as PI control, in 
accordance with the state of the perturbation model 203 for correcting body posture angles, and the determined feed- 
back quantity is additionally input to the perturbation model 203 for correcting body posture angles. 
[0507] The control law is referred to as a control law 207 for the perturbation model for correcting body posture 

10 angles, and the feedback quantity is referredto as a required value Mrf dm d of the momentfor stabilizing the perturbation 
model for correcting body posture angles. The term "required value" means the same as the required value Mpfdmd 
of the moment for stabilizing the perturbation model for correcting body horizontal positions. The moment limited and 
corrected is referred to as a moment Mrf for stabilizing the perturbation model for correcting body posture angles. 
[0508] Specifically, the control law 207 for the perturbation model for correcting body posture angles, which deter- 

15 mines the required value Mrfdmd of the moment for stabilizing the perturbation model for correcting body posture 
angles, may be represented as follows 



20 



25 



30 



required value Mrfdmd of the moment for stabilizing the 
perturbation model for correcting body posture angles 
= Krp * (correcting perturbation model's body posture angle 

ec 

- (reference body posture angle - desired body posture 
angle according to the simplified model)) 
4- Krv * correcting perturbation model's body posture angular 

velocity d6c/dt formula 1 1 

35 In the formula. "Krp" and "Krv" denote gains of feedback control. 

[0509] In the formula 11, the term (reference body posture angle - desired body posture angle according to the 
simplified model) may be substituted with 0 

[0510] Returning to explanation of the process in step S038 with reference to the functional block diagram in Figure 
42, the required value Mpfdmd of the moment for stabilizing the perturbation model for correcting body horizontal 
40 positions is determined by the control law 206 for the perturbation model for correcting body horizontal positions as 
described. above. In addition, the required value Mrfdmd of the moment for stabilizing the perturbation model for cor- 
recting body posture angles is determined by the control law 207 (formula 11) for the perturbation model for correcting 
body posture angles 

[0511] Then, an F0 calculator 208 determines the estimated (calculated) floor reaction force value F0 for the pertur- 
45 bation model for correcting body position in the case where the moment Mpf for stabilizing the perturbation model for 
correcting body horizontal positions is assumed to be 0. As described later, the sum of the full model floor reaction 
force moment Mfull and the moment Mpf for stabilizing the perturbation model for correcting body horizontal positions 
is input to the perturbation model 202 for correcting body horizontal positions. Therefore, F0 is the floor reaction force 
that is produced by the perturbation model 202 for correcting body horizontal positions when only the full model floor 
so reaction force moment Mfull with the sign being inverted is input to the perturbation model 202 for correcting body 
horizontal positions. 

[0512] Specifically, F0 is determined by the following formula. 



55 



F0 - mb*d2Xc/dt2 - 1/h * Mpf formula 12 

[0513] The first term in the right side represents the last-time floor reaction force's horizontal component for the 
perturbation model 202 for correcting body horizontal positions (at the time t-At). 
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[0514] The second term in the right side represents the floor reaction force's horizontal component directly produced 
in the perturbation model 202 for correcting body horizontal positions by the last-time moment Mpf for stabilizing the 
perturbation model for correcting body horizontal positions (that is, floor reaction force's horizontal component of 
feedthrough term). 

5 [0515] That is : the estimated value of the floor reaction force F0 for the perturbation model for correcting body po- 
sitions in the case where Mpf is assumed to be 0 is determined by subtracting the last-time moment Mpf for stabilizing 
the perturbation model for correcting body horizontal positions divided by the body translation mode floor reaction force 
ratio h from the last-time body material particle's horizontal acceleration multiplied by the mass mb of the body material 
particle of the perturbation model 202 for correcting body horizontal positions. 

10 [0516] Then, neglecting the limitations (the floor reaction force's horizontal component limitation condition and the 
ZMP limitation condition), an Min calculator 209 determines the floor reaction force's moment Min that is produced 
about the desired ZMP if it is assumed that the moment Mpf for stabilizing the perturbation model for correcting body 
horizontal positions agrees with the required value Mpfdmd of the moment for stabilizing the perturbation model for 
correcting body horizontal positions, and the moment Mrf for stabilizing the perturbation model for correcting body 

15 posture angles agrees with the required value Mrfdmd of the moment for stabilizing the perturbation model for correcting 
body posture angles. The floor reaction force's moment is referred to as an unlimited corrected desired floor reaction 
force's moment Min. The unlimited corrected desired floor reaction force's moment Min is determined by the following 
formula. 

20 

Min = Mpfdmd + Mrfdmd formula 13 

[051 7] That is, the unlimited corrected desired floor reaction force's moment Min is determined by adding the required 
value Mrfdmd of the moment for stabilizing the perturbation model for correcting body posture angles to the required 

25 value Mpfdmd of the moment for stabilizing the perturbation model for correcting body horizontal positions. 

[0518] Now, it will be proven that the formula 13 holds. As described later, the moment Mp for the perturbation model 
for correcting body horizontal positions is determined as a value obtainedby subtracting the full model' s floor reaction 
force' s moment Mful! from the moment Mpf for stabilizing the perturbation mode! for correcting body horizontal posi- 
tions, and the moment Mr for the perturbation model for correcting body posture angles is determined to be Mrf (see 

30 the formulas 22 and 23 described later). 

[0519] Therefore, the corrected desired floor reaction force's moment determined by the formula 5 is expressed as 
the following formula. 

35 corrected desired floor reaction force's moment = Mpf + Mrf formula 14 

[0520] Thus, the formula 13 results if the required value Mpfdmd of the moment for stabilizing the perturbation model 
for correcting body horizontal positions is substituted into the moment Mpf for stabilizing the perturbation model for 
correcting body horizontal positions in the formula 14, and the required value Mrfdmd of the moment for stabilizing the 
40 perturbation model for correcting body posture angles is substituted into the moment Mrf for stabilizing the perturbation 
model for correcting body posture angles. 

[0521] Then, neglecting the limitations (the floor reaction force's horizontal component limitation condition and the 
ZMP limitation condition), an Fin calculator 210 determines the floor reaction force's horizontal component Fin that is 
produced if the moment Mpf for stabilizing the perturbation model for correcting body horizontal positions agrees with 
45 the required value Mpfdmd of the moment for stabilizing the perturbation model for correcting body horizontal positions, 
and the moment Mrf for stabilizing the perturbation model for correcting body posture angles agrees with the required 
value Mrfdmd of the moment for stabilizing the perturbation model for correcting body posture angles. The floor reaction 
force's horizontal component is referred to as an unlimited corrected desired floor reaction force's horizontal component 
Fin. 

50 [0522] The corrected desired floor reaction force's horizontal component is determined by the formula 6, and as 
described above, a behavior of the perturbation model 203 for correcting body posture angles causes no floor reaction 
force's horizontal component in the perturbation model 203 for correcting body posture angles, that is ; Fr is 0. Therefore, 
the unlimited corrected desired floor reaction force's horizontal component Fin is a sum of the corrected desired floor 
reaction force's horizontal component in the case where the moment Mpf for stabilizing the perturbation model for 

55 correcting body horizontal positions is assumed to be 0 and the increment of the floor reaction force's horizontal com- 
ponent caused by changing the moment Mpf for stabilizing the perturbation model for correcting body horizontal posi- 
tions to the required value Mpfdmd of the moment for stabilizing the perturbation model for correcting body horizontal 
positions. 
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[0523] The increment of the floor reaction force's horizontal component caused by changing the moment Mpf for 
stabilizing the perturbation model for correcting body horizontal positions from 0 to the required value Mpfdmd of the 
moment for stabilizing the perturbation model for correcting body horizontal positions equals to the required value 
Mpfdmd of the moment for stabilizing the perturbation mode! for correcting body horizontal positions divided by the 

5 body translation mode floor reaction force ratio h. 

[0524] Therefore, as shown by Lhe formula 15, the unlimited corrected desired floor reaction force's horizontal com- 
ponent Fin is obtained by dividing lhe required value Mpfdmd of the moment for sLabiiizing the perturbation model for 
correcting body horizontal positions divided by the body translation mode floor reaction force ratio h ; adding the resulting 
value to the full models floor reaction force's horizontal component Ffull, and further adding the resulting value to the 

10 floor reaction force F0 for the perturbation model for correcting body positions calculated on the assumption that the 
moment Mpf for stabilizing the perturbation model for correcting body horizontal positions is 0. 

Fin = 1/h * Mpfdmd + Ffull + F0 formula 15 

15 

[0525] Then, using limiter means described in detail later, a limitation processor 211 determines a limited corrected 
desired floor reaction force's moment Mltd (about the desired ZMP) and a limited corrected desired floor reaction force's 
horizontal component Fltd f rom the unlimited corrected desired floor reaction force's moment Min and the unlimited 
corrected desired floor reaction force's horizontal component Fin. As described later, the floor reaction force's moment 

20 (about the ZMP) for the corrected gait agrees with the limited corrected desired floor reaction force's moment Mltd. 
and the floor reaction force's horizontal component for the corrected gait agrees with the limited corrected desired floor 
reaction force's horizontal component Fltd (see the proof of the formulas 26 and 27 described later). 
[0526] The limited corrected desired floor reaction force's moment Mltd and the limited corrected desired floor reaction 
force's horizontal component Fltd are determined in such a manner that the true ZMP for the corrected gait lies within 

25 the ZMP allowable range, and the floor reaction force's horizontal component for the corrected gait falls within the floor 
reaction force's horizontal component allowable range. That is, the values Mltd and Fltd are determined so as to satisfy 
the ZMP limitation condition and the floor reaction force's horizontal component limitation condition. 
[0527] In addition, under the limitation conditions, the moment Mp for stabilizing the perturbation model for correcting 
body horizontal positions is determined so as to agree with or approximate to the required value Mpfdmd of the moment 

so for stabilizing the perturbation model for correcting body horizontal positions as closely as possible. Similarly, the mo- 
ment Mr for stabilizing the perturbation model for correcting body posture angles is determined so as to agree with or 
approximate to the required value Mrfdmd of the moment for stabilizing the perturbation model for correcting body 
posture angles as closely as possible. In this way, the correcting perturbation model's body position Xc and the cor- 
recting perturbation model's body posture angle ec are stabilized and prevented from diverging. 

35 [0528] Then, using the following formulas, an Mpf calculator 212 and an Mrf calculator 213 determine the moment 
Mpf for stabilizing the perturbation model for correcting body horizontal positions and the moment Mrf for stabilizing 
the perturbation model for correcting body posture angles, respectively. 

40 Mpf = (Fltd - Ffull - F0)*h formula 20 



Mrf - Mltd - Mpf formula 21 

45 [0529] That is, the Mpf calculator 21 2 determines the moment Mpf for stabilizing the perturbation model for correcting 
body horizontal positions by subtracting, from the limited corrected desired floor reaction force's horizontal component 
Fltd, the full model's floor reaction force's horizontal component Ffull and the floor reaction force value F0 of the per- 
turbation model 202 for correcting body positions that is calculated on the assumption that Mp is 0 f and multiplying the 
resulting value by the body translation mode floor reaction force ratio h. Besides, the Mrf calculator 213 determines 

50 the moment Mrf for stabilizing the perturbation model for correcting body posture angles by subtracting the moment 
Mpf for stabilizing the perturbation model for correcting body horizontal positions from the limited corrected desired 
floor reaction force's moment Mltd about the desired ZMP. 

[0530] Then , by the following formulas, the floor reaction force's moment Mp for the perturbation model for correcting 
body horizontal positions and the floor reaction force's moment Mr for the perturbation model for correcting body posture 
55 angles are determined. 

Mp - Mpf - Mfull formula 22 
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Mr-Mrf formula 23 

[0531] That is. in the Mp calculator 214, the full model floor reaction force's moment M fill I is subtracted from the 
5 moment Mpf for stabilizing the perturbation model for correcting body horizontal positions, thereby determining the 
floor reaction force's moment Mp for the perturbation model for correcting body horizontal positions. In addition, the 
floor reaction force's moment Mr for the perturbation model for correcting body posture angles is set to the same value 
as the moment Mrf for stabilizing the perturbation model for correcting body posture angles. 

[0532] Then , the floor reaction force's moment Mp for the perturbation model for correcting body horizontal positions 
io is input to the perturbation model 202 for correcting body horizontal positions, and the correcting perturbation model's 
body horizontal position Xc in balance with the input floor reaction force's moment is calculated 

[0533] In addition, the floor reaction force's moment Mr for the perturbation model for correcting body posture angles 
is input to the perturbationmodel 203 for correcting body posture angles, and the correcting perturbation model's body 
posture angle 6c in balance with the input floor reaction force' s moment is calculated. 
15 [0534] Then , in the calculators 205 and 204. the corrected desired body horizontal position and the corrected desired 
body posture angle are determined according to the following formulas 24 and 25, respectively, and the results are 
output as the final desired instantaneous values of the body horizontal position and posture. 

20 corrected desired body horizontal position 

= simplified model's body horizontal position + correcting 

perturbation model's body position Xc formula 24 



25 



30 



45 



50 



55 



corrected desired body posture angle 
simplified model's body posture angle + corrected 
perturbation model's body posture angle 6c formula 25 



[0535] That is, the correcting perturbation model's body position Xc is added to the simplified model's body horizontal 
position, thereby providing the corrected desired body horizontal position, and the corrected desired body horizontal 
35 position is output. In addition, the correcting perturbation model's body posture angle 0c is added to the simplifiedmodeP 
s body posture angle, thereby providing the corrected desired body posture angle, and the corrected desired body 
posture angle is output. 

[0536] The limited corrected desired floor reaction force's moment Mltd is output as the corrected desired floor re- 
action force's moment about the desired ZMP, and the limited corrected desired floor reaction force's horizontal com- 
40 ponent Fltd is output as the corrected desired floor reaction force's horizontal component. 

[0537] That is, as the final desired instantaneous values of the floor reaction force's horizontal component and the 
floor reaction force's moment (about the desired ZMP) , the corrected desired floor reaction force's horizontal compo- 
nent and the corrected desired floor reaction force's moment about the desired ZMP are determined according to the 
formulas 27 and 26, respectively, and the results are output. 



corrected desired floor reaction force's moment 
= limited corrected desired floor reaction force's moment 

Mltd formula 26 

corrected desired floor reaction force's horizontal component 
- limited corrected desired floor reaction force's horizontal 

component Fltd formula 27 
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20 



[0538] The gait correction in step S038 is conducted as described above. 

[0539] Now, it will be proven that, for the gait (corrected gait) having such a corrected body horizontal position and 
such a corrected body posture angle ; the corrected desired floor reaction force's horizontal component and the cor- 
rected desired floor reaction force's moment about the desired ZMP that substantially satisfy the dynamical equilibrium 

5 condition (dynamical equilibrium condition on the inverse full model 201) are determined by the formulas 26 and 27. 
[0540] If the formulas 20 ; 21 . 22 and 23 are substituted for the left side of the formula 5 : the corrected desired floor 
reaction force's moment for satisfying Lhe dynamical equilibrium condition is Mltd. Thus, it is proven thai the corrected 
desired floor reaction force's moment for satisfying the dynamical equilibrium condition is determined by the formula 26. 
[0541] On the other hand, if the formulas a20. a21 , 12 and 20 are substituted for the left side of the formula 6, the 

10 corrected desired floor reaction force's horizontal component for satisfying the dynamical equilibrium condition is Fltd, 
as described by the following formula. Thus, it is proven that the corrected desired floor reaction forces horizontal 
component for satisfying the dynamical equilibrium condition is determined by the formula 27. 

15 corrected desired floor reaction force's horizontal component 

= mb*d2Xc/dt2 + Ffull 
= F0 + 1/h * Mpf + Ffull 
- F0 + 1/h * (Fltd - Ffull - F0)*h +• Ffull 

= Fltd formula 30 

25 [0542] Incidentally, in the first embodiment, the correction method is of feed forward type, and the perturbation dy- 
namics model is not a strict model. Therefore, even if the gait is corrected so as to satisfy the formulas 5 and 6 as 
described above, the dynamical equilibrium condition is not satisfied in a strict manner but satisfied in an approximate 
manner. 

[0543] Now, details of the limiter means, that is, details of the processing in the limitation processor 211 will be 
30 described. 

[0544] In the limiter means (limitation processor 211 ), the following processings are performed to provide the above 
described function. 

[0545] First, the instantaneous value of the ZMP allowable range determined by the desired instantaneous value 
generator 100b, that is. the instantaneous value of the ZMP allowable range determined in step S036 in Figure 13 is 
35 converted into the instantaneous value of the allowable range of the floor reaction force's moment about the desired 
ZMP. 

[0546] Specifically, the following formula is used to determine the floor reaction force's moment allowable range. 

40 floor reaction force's moment allowable range 

= (ZMP allowable range - desired ZMP) * floor reaction 

force's vertical component's vector formula 32 

45 

In the formula 32. all the variables are vectors. The floor reaction force's vertical component's vector is a translation 
floor reaction force's vector with the components other than the vertical component being 0. The symbol n *" means 
outer product. 

[0547] The ZM P allowable range has to be determined in accordance with the supporting polygon and generally has 
50 a complicated shape. However, for simplifying calculation, it is assumed to be a rectangular region on the floor surface. 
That is, the back-and-forth directional (X axis directional) components and the sideward directional (Y axis directional) 
components of the ZMP allowable range and therefore the floor reaction force's moment allowable range derived 
therefrom are set independently. 

[0548] For example, if the supporting polygon and the desired ZMP are related to each other as shown in Figure 45, 
55 the ZMP allowable range is set tobe contained in the supporting polygon as shown in the drawing. At the same time, 
the ZMP allowable range is set to contain the desired ZMP. The supporting polygon in the example shown in Figure 
45 is one during the two leg supporting period in the walking gait, and the rectangular areas at the both ends represent 
the contact surfaces of the feet 22 of the legs 2 (surfaces in contact with the floor). 
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[0549] In the one leg supporting period in the walking or running gait, the supporting polygon is identical with the 
contact surface of the supporting leg's foot 22 (surface in contact with the floor). In this case, the ZMP allowable range 
is set to contain the desired ZMP and to be contained in, or substantially agree with, the supporting polygon. Besides, 
in the floating period in the running gait, the ZMP allowable range is set to a region centered on the desired ZMP and 

5 having X axis and Y axis directional widths of 0. that is, the desired ZM P itself (this means a region having an area of 0) . 
[0550] As for Ihe floor reaction force's horizontal component allowable range for gait correction, the back-and-forth 
directional (X axis directional) component and the sideward directional (Y axis directional) component are set inde- 
pendently. In this case, as with the floor reaction force's horizontal component allowable range for the simplified model 
gait, the X axis directional and Y axis directional components are set according to the formula c1 2. for example. In this 

10 case, as described above, the floor reaction force's horizontal component allowable range is preferably set to reliably 
fall within the friction limit by making it narrower than the allowable range for the simplified model gait, for example. 
[0551] It is known that a movement with a gait that satisfies only the dynamical equilibrium condition (in particular, 
that the horizontal component of the moment applied about the desired ZMP by the resultant force of gravity and the 
inertial force is 0) without considering the ZMP limitation condition and the floor reaction force's horizonta! component 

15 limitation condition satisfies the dynamical equilibrium condition in an approximate manner even if a movement on the 
sagittal plane and a movement on the lateral plane, which are separately generated so as to each satisfy the dynamical 
equilibrium condition, are synthesized to provide the relevant movement. In addition, setting the ZMP allowable range 
and the floor reaction force's horizontal component allowable range for gait correction as described above allows the 
ZMP limitation condition and the floor reaction force's horizontal component limitation condition to be separated into a 

20 limitation condition on the sagittal plane and a limitation condition on the lateral plane. Therefore, as for a movement 
with a gait taking into consideration all of the ZMP limitation condition, the floor reaction force's horizontal component 
limitation condition and the dynamical equilibrium condition, the movement can be provided by synthesizing a move- 
ment on the sagittal plane and a movement on the lateral plane, which are separately generated. 
[0552] Thus, in the following description, to be readily understood, an operation of the limiter means will be described 

25 only with respect to a movement on the sagittal plane. However, the same holds true for a movement on the lateral plane. 
[0553] By simplification as described above, the fact that the floor reaction force's moment for the corrected gait falls 
within the floor reaction force' s moment allowable range (this means that the true ZMP for the movement with the 
corrected gait lies within the ZMP allowable range) is expressed by the following formula. In this formula, Mmax denotes 
an upper limit of the floor reaction force's moment allowable range, and Mmin denotes a lower limit thereof . 

30 

Mmax > floor reaction force's moment for the corrected 

gait > Mmin formula 33 

35 

[0554] In addition, the fact that the floor reaction force's horizontal component for the corrected gait falls within the 
floor reaction force's horizontal component allowable range is expressed by thefollowing formula. In this formula, Fmax 
denotes an upper limit of the floor reaction force's horizontal component allowable range, and Fmin denotes a lower 
limit thereof. 

40 

Fmax > floor reaction force 1 s horizontal component > Fmin formula 34 

[0555] In addition, as described above, the floor reaction force's moment for the corrected gait exactly or substantially 
45 agrees with the limited corrected desired floor reaction force's moment Mltd, and the floor reaction force' s horizontal 
component for the corrected gait exactly or substantially agrees with the limited corrected desired floor reaction force's 
horizontal component Fltd. 

[0556] Therefore, the formulas 33 and 34 can be transformed to the following formulas 35 and 36, respectively, in 
an approximate manner. 

50 

Mmax > Mltd > Mmin formula 35 



Fmax > Fltd > Fmin formula 36 

[0557] In acoordinate systemhaving a horizontal axis indicating a component, about the X axis (back-and-forth axis), 
of the floor reaction force's horizontal component and a vertical axis indicating a component, about the Y axis (sideward 
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axis) , of the floor reaction force's moment shown in Figure 46, if it is assumed that a set (Fltd, Mltd) of the limited 
corrected desired floor reaction force's horizontal component Fltd and the limited corrected desired floor reaction force's 
moment Mltd is a point on the coordinate system, a group of points that satisfy the formulas 35 and 36 (allowable 
range) lies within the rectangular and on the boundary thereof shown in Figure 46. 

5 [0558] As shown by a white spot in Figure 46 (the white spot overlies a black spot described later in the drawing) , 
if Lhe unlimited corrected desired floor reaction force's moment Min falls within the floor reaction force's moment allow- 
able range, and the unlimited corrected desired floor reaction force's horizontal component Fin falls within the floor 
reaction force's horizontal component allowable range, that is, if a point (Fin, Min) lies within the rectangular region 
defined by the floor reaction force's moment allowable range and the floor reaction force's horizontal component al- 

10 lowable range, the value Mltd is the same as the unlimited corrected desired floor reaction force's moment Min, and 
the value Fltd is the same as the unlimited corrected desired floor reaction force's horizontal component Fin ; as indicated 
by the black spot in the drawing. Of course, this in itself allows the formulas 35 and 36 to hold. That is ; the floor reaction 
force's moment for the corrected gait falls within the floor reaction force's moment allowable range, and the floor reaction 
force's horizontal component for the corrected gait falls within the floor reaction force's horizontal component allowable 

15 range. In addition, the unlimited corrected desired floor reaction force's moment Min and the unlimited corrected desired 
floor reaction force's horizontal component Fin are output as Mltd and Fltd without being limited (corrected). Thus, the 
correcting perturbation model's body position and the correcting perturbation model's body posture angle can be ad- 
equately stabilized and prevented from diverging. 

[0559] As shownbywhite spots in Figures 47 to 49, if the unlimited corrected desired floor reaction force's moment 
20 Min doesn't fall within the floor reaction force's moment allowable range orthe unlimited corrected desired floor reaction 
force's horizontal component doesn't fall within the floor reaction force's horizontal component allowable range, that 
is, if the point (Fin, Min) doesn't lie within the rectangular region defined by the floor reaction force's moment allowable 
range and the floor reaction force's horizontal component allowable range, the values Mltd and. Fltd are determined as 
described below. 

25 [0560] Before describing a method of determining the values Mltd and Fltd, a principle of the determination will be 
described. 

[0561] If, simply, the value Mltd is set to the unlimited corrected desired floor reaction force's moment Min and the 
value Fltd is set to the unlimited corrected desired floor reaction force's horizontal component Fin : the floor reaction 
force's moment for the corrected gait doesn't fall within the floor reaction force's moment allowable range, or the floor 

30 reaction force's horizontal component for the corrected gait doesn't fall within the floor reaction force's horizontal com- 
ponent allowable range. The moment Mpf for stabilizing the perturbation model for correcting body horizontal positions 
and the moment Mrf for stabilizing the perturbation model for correcting body posture angles at that time can be de- 
termined by substituting Min and Fin into Mltd and Fltd. respectively, in the formulas 20 and 21 . In order for the floor 
reaction force's moment for the corrected gait to fall within the floor reaction force's moment allowable range and for 

35 the floor reaction force's horizontal component for the corrected gait to fall within the floor reaction force's horizontal 
component allowable range, the values Mpf and Mrf thus determined have to be changed. In this regard, in this em- 
bodiment, priority is given to a condition that the value Mrf agrees with the required value Mrfdmd of the moment for 
stabilizing the perturbation model for correcting body posture angles as closely as possible, that is, the shift to be 
corrected of the value Mrf from the value Mrfdmd is reduced to a minimum. 

40 [0562] A reason for this will be described below. 

[0563] The floor reaction force's moment that can be corrected by the perturbation model 203 for correcting body 
posture angles is relatively small, and if a large moment is to be corrected, the body posture angle varies significantly. 
Thus, correction of the simplified model gait using the inverse full model 201 is preferably conducted by adding a 
movement of the perturbation model 202 for correcting body horizontal positions to the simplified model gait as much 

45 as possible. And, it is preferable that, if the movement of the perturbation model 202 for correcting body horizontal 
positions is not sufficient to correct the simplifiedmodel gait, the simplified model gait is corrected by further adding a 
movement of the perturbation model 203 for correcting body posture angles to the simplified model gait. Therefore, it 
is preferable that restoration of the perturbation model 203 for correcting body posture angles (restoration to the ref- 
erence body posture angle) is given a higher priority than restoration of the perturbation model 202 for correcting body 

50 horizontal positions (restoration of the body horizontal position to a stable position). That is, it is preferable to give 
priority to a condition that the value Mrf, which is a quantity manipulated for restoring the perturbation model 203 for 
correcting body posture angles : agrees with the required value Mrfdmd of the moment for stabilizing the perturbation 
model for correcting body posture angles as closely as possible. 

[0564] In order for the value Mrf to agree with the required value Mrfdmd of the moment for stabilizing the perturbation 
55 model for correcting body posture angles, of the values Mpf and Mrf obtained by substituting Min and Fin into Mltd and 
Fltd, respectively, in the formulas 20 and 21 , only the value Mpf has to be changed without changing the value Mrf. 
[0565] A change amount of Fltd is denoted by AF, and a change amount of Mltd is denoted by AM. That is. the values 
Fltd and Mltd are changed as shown by the following formulas. 
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Fltd - Fin + AF 



formula 37 



10 



15 



40 



Mltd = Min + AM formula 38 

[0566] Besides, from the formulas 20 and 21 , the following relationship results. 

Mrf - Mltd - (Fltd - Ffull - F0)*h formula 39 

[0567] As can be apparently seen from the formulas 37 to 39, if the following formula holds, the value Mrf is not 
changed. 

AM = AF * h formula 40 



[0568] Thus, the values AF and AM have to satisfy the formula 40. 

[0569] Furthermore, it is desirable that the value Mpf is close to the required value Mpfdmd of the moment for sta- 
20 bilizing the perturbation model for correcting body horizontal positions as precisely as possible, and therefore, the 
change amount AF (or AM) is determined to have a minimum absolute value. Furthermore, the values Fltd and Mitd 
are determined using the formulas 37 and 38. This allows at least the correcting perturbation model's body posture 
angle 0c to be adequately stabilized and prevented from diverging, and furthermore, the correcting perturbation model's 
body horizontal position Xc can be stabilized and prevented from diverging to the extent possible. 
25 [0570] In Figures 47 and 48, indicating a set of the values Fltd and Mltd thus determined by a black spot (Fltd 7 Mltd), 
the black spot is a point closest to the white spot (Fin, Min) among the points of intersection of a straight line passing 
through the white spot (Fin, Min) and having an inclination of h, which is a body translation mode floor reaction force 
ratio, and the boundary of the allowable range expressed by the formulas 35 and 36. 

[0571] Incidentally, the straight line is a set of points (Fltd, Mltd) that satisfy the formulas 37, 38 and 40. Besides, if 
30 only the moment Mpf for stabilizing the perturbation model for correcting body horizontal positions is changed from the 
state of the white spot, the ratio between the change amount AM of Mltd and the change amount of AF of the Fltd 
equals to the body translation mode floor reaction force ratio h. From this fact also, it can be seen that the straight line 
is a set of points (Fltd Mltd) in the case where only the moment Mpf for stabilizing the perturbation model for correcting 
body horizontal positions is changed from the state where the point (Fltd, Mltd) agrees with the point (Fin, Min). 
35 [0572] However, as shown in Figure 49, if there are no values Fltd and Mltd that satisfy the formulas 35, 36, 37, 38 
and 40, the values Fltd and Mltd are determined as described below. In this case, giving up keeping the value Mr 
constant, it is to be considered to reduce the change amount of Mr to a minimum. 
[0573] Thus, instead of the formula 40, the following formula 41 is used. 



AM - AF * h + AMp2 formula 41 



[0574] The values Fltd and Mltd are determined so as to satisfy the formulas 35, 36, 37, 38 and 41 . Here, as the 
value AMp2 becomes closer to 0, the change amount of Mr becomes smaller. Therefore, the value AMp2 is determined 

45 to have a minimum absolute value. Furthermore, in addition to these conditions being satisfied, it is desirable that the 
value Mp is close to the required value Mpfdmd of the moment for stabilizing the perturbation model for correcting body 
horizontal positions as precisely as possible, and therefore, the value AF is determined to have a minimum absolute 
value. This allows at least the correctingperturbationmodel' s body posture angle 0c to be adequately stabilized and 
prevented from diverging to the extend possible, and furthermore, the correcting perturbation model's body horizontal 

50 position Xc can be stabilized and prevented from diverging to the extent possible. 

[0575] In Figure 49, indicating a set of the values Fltd and Mltd thus determined by a black spot (Fltd, Mltd), the black 
spot is a point closest to a straight line passing through the white spot (Fin, Min) and having an inclination of h, which 
is a body translation mode floor reaction force ratio, among the apexes of the boundary of the rectangular region defined 
by the allowable ranges expressed by the formu las 35 and 36 (i.e. , the points of intersection of the four lines representing 

55 the upper limits and the lower limits of the allowable ranges, or mores generally, the points on the boundary of the 
rectangular region defined by the allowable ranges). 

[0576] In this way, the limited corrected desired floor reaction force's moment Mltd about the desired ZMP and the 
limited corrected desired floor reaction force's horizontal component Fltd are determined. 
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[0577] Incidentally, when the floor reaction force's vertical component is 0 (during the floatingperiodof the running 
gait) : the upper limit values Mmax and Fmax and the lower limit values Mmin and Fmin in the formulas 35 and 36 are 
0. and therefore, both the limited corrected desired floor reaction force's moment Mltd about the desired ZMP and the 
limited corrected desired floor reaction force's horizontal component Fltd are 0. 
5 [0578] Returning to the flowchart in Figure 13. after the processing in step S038 is performed, the process proceeds 
lo slep S040, where Lhe lime t is incremented by At. Then, the process returns to step S014, and the processings from 
steps S014 to S040 are repeated. 

[0579] The operation of the gait generation device according to this embodiment will be further described with ref- 
erence to Figure 4. The gait generation device 100 generates the corrected gait as described above. The corrected 
10 body position/posture (trajectory) and the desired arm posture (trajectory) of the corrected gait are directly transmitted 
to a robot geometrical model (inverse kinematics calculator) 102. 

[0580] Besides, the desired foot position/posture trajectory, the desired total floor reaction force central point (that 
is, desired ZMP) trajectory and the desired total floor reaction force trajectories (specifically, the desired floor reaction 
force's vertical component trajectory, the corrected desired floor reaction force's horizontal component trajectory and 

15 the trajectory of the corrected desired floor reaction force's moment about the desired ZMP) are transmitted directly 
to a composite-compliance operation determinator 1 04 and to a desired floor reaction force distributor 1 06. Then, the 
desired floor reaction force distributor 106 distributes the corrected desired floor reaction force among the feet 22R 
and 22L and determines the desired each-foot floor reaction force central point and the desired each-foot floor reaction 
force. The desired each-foot floor reaction force central point and the desired each-foot floor reaction force thus de- 

20 termined are transmitted to the composite-compliance operation determinator 104. 

[0581] The composite-compliance operation determinator 104 transmits a corrected desired foot position/posture 
(trajectory) w/t deformation compensation to the robot geometrical model 1 02. Upon receiving the desired body position/ 
posture (trajectory) and the corrected desired foot position/posture (trajectory) w/t deformation compensation , the robot 
geometrical model 102 calculates joint displacement commands (values) for the twelve joint (such as 10R(L)) of the 

25 legs 2,2 and transmits the commands to a displacement controller 108. The displacement controller 108 controls the 
twelve joints of the legs 2, 2 of the robot 1 by following the joint displacement commands (values) calculated by the 
robot geometrical model 102 as desired values.' Besides, the robot geometrical model 102 calculates displacement 
commands (values) for the arm joints that satisfy the desired arm posture and transmits the commands to the displace- 
ment controller 108. The displacement controller 1 08 controls the ten (or 8) joints of the arms of the robot 1 by following 

30 the joint displacement commands (values) calculated by the robot geometrical model 1 02 as desired values. 

[0582] The floor reaction force (specifically, actual each-foot floor reaction force) produced in the robot 1 is detected 
by the six-axis force sensor 34. The detection value is transmitted to the composite-compliance operation determinator 
1 04. In addition, the posture inclination deviations eerrx and Berry produced in the robot 1 are detected by the inclination 
sensor 36, and the detection values are transmitted to a posture stabilizing control calculator 112 (specifically, the 

35 deviation of the actual posture angle with respect to the desired body posture angle in the roll direction (about the X 
axis) is denoted by Berrx, and the deviation of the actual posture angle with respect to the desired body posture angle 
in the pitch direction (about the Y axis) is denoted by Berry). Then, the posture stabilizing control calculator 112 calcu- 
lates the compensating total floor reaction force's moment about the desired total floor reaction force central point 
(desired ZMP) for restoring the body posture angle of the robot 1 to the desired body posture angle. Furthermore, the 
corrected desired floor reaction force's moment about the desired ZMP is added to the compensating total floor reaction 
force's moment, and the result is transmitted to the composite-compliance operation determinator 104. Based on the 
input value, the composite-compliance operation determinator 104 corrects the corrected desired floor reaction force. 
Specifically, the desired floor reaction force is corrected so that the sum of the compensating total floor reaction force's 
moment and the corrected desired floor reaction force's moment is applied about the desired total floor reaction force 

45 central point (desired ZMP). 

[0583] The composite-compliance operation determinator 1 04 determines the corrected desired foot position/posture 
(trajectory) w/t deformation compensation in order for the states and floor reaction force of the actual robot calculated 
from the sensor detection values or the like to agree with the corrected desired floor reaction force. However, it is 
actually impossible that all the states agree with their respective desired values, and therefore, various trade-offs are 

50 made among these states so that each of them agrees with its desired value as closely as possible. That is, a control 
deviation for each desired value is weighted, and the weighted average of the control deviation (or the square of the 
control deviation) is controlled to be minimum. Thus, the actual foot position/posture and the actual total floor reaction 
force are controlled so as to generally agree with the desired foot position/posture and the desired total floor reaction 
force, respectively. 

55 [0584] Since the present invention essentially concerns robot gait generation by the gait generation device 1 00, and 
the configuration and operation of the composite-compliance operation determinator 104 or the like are described in 
detail in Japanese Patent Laid-Open No . 1 0-277969 previously filled by the applicants or the like, further details thereof 
will not be described herein. 
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[0585] As described above, in this embodiment, the limited corrected desired floor reaction force's moment Mltd and 
the limited corrected desired floor reaction force's horizontal component Fltd are determined in such a manner that the 
true ZMP for the corrected gait lies within the ZMP allowable range, and the floor reaction force's horizontal component 
for the corrected gait falls within the floor reaction force's horizontal component allowable range (that is, in such a 
5 manner that the ZMP limitation condition and the floor reaction force's horizontal component limitation condition are 
salisfied). 

[0586] Furthermore, under the limitation conditions, Lhe moment Mp for stabilizing the perturbation model for cor- 
recting body horizontal positions is determined to agree with or be close to the required value Mpfdmd of the moment 
for stabilizing the perturbation model for correcting body horizontal positions as accurately as possible, and the moment 
10 Mr for stabilizing the perturbation model for correcting body posture angles is determined to agree with or be close to 
the required value Mrfdmd of the moment for stabilizing the perturbation model for correcting body posture angles as 
accurately as possible. In this way, the correcting perturbation model's body position Xc and the correcting perturbation 
model' s body posture angle Oc are stabilized and prevented from diverging. 

[0587] The floor reaction force' s moment that can be corrected by the perturbation model 203 for correcting body 

75 posture angles is relatively small, and if a large moment is to be corrected, the body posture angle varies significantly. 
Therefore, correction of the simplified model gait using the inverse full model 201 is conducted by adding the movement 
of the perturbation model 202 for correcting body horizontal positions to the simplified model gait as much as possible. 
And, it is preferable that, if the movement of the perturbation model 202 for correcting body postures/positions is not 
sufficient to correct the simplified model gait, the simplified model gait is corrected by further adding a movement of 

20 the perturbation model 203 for correcting body posture angles to the simplified model gait. Therefore, it is preferable 
that restoration of the perturbation model 203 for correcting body posture angles is given a higher priority than resto- 
ration of the perturbation model 202 for correcting body horizontal positions. That is, it is preferable to give priority to 
a condition that the value Mrf, which is a quantity manipulated for restoring the perturbation model 203 for correcting 
body posture angles, agrees with the required value Mrfdmd of the moment for stabilizing the perturbation model for 

25 correcting body posture angles as closely as possible. 

[0588] Now, associations of the first embodiment described above with the present invention will be described. The 
first embodiment is associated with the first to fifteenth implementations of the present invention (except for the eleventh 
implementation and the implementation(s) based essentially on the eleventh implementation. The same holds true for 
the following description unless the eleventh implementation is mentioned in particular). In this case, the allowable 

30 range setting means according to the first to fifteenth implementations is associated with the processings in steps S030 
and S036 in the flowchart in Figure 13, and the allowable ranges of the translation floor reaction force's horizontal 
component and the ZMP (true ZMP) , which are to be limited, are set. In addition, the provisional instantaneous value 
determining means according to the first to fifteenth implementations is associated with the processing in step S032 
(calculation of the simplified model gait's instantaneous values) in the flowchart in Figure 13. In this case, in particular, 

35 the instantaneous value of the body position/posture, the instantaneous value of the floor reaction force's horizontal 
position, the desired ZMP, and the instantaneous value of the floor reaction force's moment about the desired ZMP (= 
0) are determined as provisional instantaneous values. The model calculation means according to the first to fifteenth 
implementations is associated with the processings of determining the full-model's floor reaction force's horizontal 
component Ffull and the full-model's floor reaction force's moment Mfull as model floor reaction force instantaneous 

40 values using the inverse full model 201 , which is a dynamics model (in particular, processing of determining Mfull). In 
addition, the desired instantaneous value determining means according to the first to fifteenth implementations is as- 
sociated with the processing in step S038 in the flowchart in Figure 13. in this case, the full-model 1 s floor reaction 
force's moment Mfull is equivalent to the difference between the model floor reaction force instantaneous value and 
the provisional instantaneous value of the desired floor reaction force. As the desired instantaneous value of the desired 

45 floor reaction force in the third or fifteenth implementation, the corrected desired floor reaction force's moment or cor- 
rected desired floor reaction force's horizontal component in the case where the desired ZMP is the point of application 
is determined. 

[0589] Furthermore, the first embodiment includes the perturbation model 202 for correcting body horizontal positions 
and the perturbation model 203 for correcting body posture angles, which are perturbation models in the fourth to tenth 

50 implementations and the twelfth to fifteenth implementations (except for the implementation(s) based essentially on 
the eleventh implementation). In this case, as perturbation model manipulating quantities, the moment Mp for the 
perturbation model for correcting body horizontal positions and the moment Mr for the perturbation model for correcting 
body posture angles are determined, and input to the perturbation models 202 and 203, thereby determining the cor- 
recting perturbation model's body horizontal position Xc and the correcting perturbation model's body posture angle 

55 ec as correction quantities for the desired movement. In addition, the full model 1 s floor reaction force's moment Mfull 
with the sign inverted (input to the Mp calculator 21 4) is used as a first manipulating quantity component of the pertur- 
bation model manipulating quantity, and the moment Mpf for stabilizing the perturbation model for correcting the body 
horizontal position and the moment Mrf for stabilizing the perturbation model for correcting body posture angles (which 
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equals to Mr in the first embodiment) are involved as second manipulating quantity components of the perturbation 
model manipulating quantity. In addition, the required value Mpfdmd of the moment for stabilizing the perturbation 
model for correcting body horizontal positions and the required value Mrfdmd of the moment for stabilizing the pertur- 
bation model for correcting body posture angles are used as required values of the perturbation model manipulating 

5 quantities In addition, as estimated values of the limitation-target quantities in the twelfth and thirteenth implementa- 
tions, the unlimited corrected desired floor reaction force's moment Min and the unlimited corrected desired floor re- 
action force's horizontal component Fin are determined by the Min calculator 209 and the Fin calculator 210, respec- 
tively, and as limitation-target quantities having been limited, the limited corrected desired floor reaction force's moment 
Mltd and the limited corrected desired floor reaction force's horizontal component Fltd are determined by the limitation 

10 processor 211 . Besides, the "predetermined part" of the robot according to the eighth implementation is the body 24 
of the robot 1 . 

[0590] If the floor reaction force's moment about the desired ZMP is not 0, it means that the true ZMP is displaced 
from the desired ZMP by a distance derived by dividing the floor reaction force's moment by the floor reaction force's 
vertical component. Therefore, of course, the floor reaction force's moment used in the first embodiment can be ap- 

15 propriately converted into the ZMP using the desired floor reaction force's vertical component. 

[0591] In addition, the eleventh implementation involves no required value for the perturbation models, and the em- 
bodiment in this case can be provided by setting both the values Mpfdmd and Mpfdmd in the first embodiment to 0. 
Thus, the embodiment concerning the eleventh implementation and the implementation(s) based essentially thereon 
is provided. Associations of this embodiment with the eleventh implementation or the like are the same as the associ- 

20 ations concerning the first embodiment. 

[0592] Now, a second embodiment of the present invention will be described. A correction method for a device 
according to the second embodiment is of a full model feed forward type. Furthermore, the method uses the inverse 
dynamics full model (inverse full model), doesn't correct the input of the simplified model gait and uses a perturbation 
model. 

25 [0593] Figure 50 is a functional block diagram for illustrating an operation of the device according to the second 
embodiment, specifically, the gait correction method in step S038 in the flowchart in Figure 13. However, as in the first 
embodiment, a simplifiedmodel 200 shown in Figure 50 is not simply a dynamics model but represents the process 
from steps S010 to S034 described above, that is. calculation (determination) of the simplified model gait's instanta- 
neous values. Therefore, the sections following the simplified model 200 in Figure 50 are associated with the processing 

30 jn step S038. Of the functional sections shown in Figure 50, same functional sections as those in the first embodiment 
shown in Figure 42 are assigned the same reference numerals as those in Figure 42, 

[0594] The points other than the processing in step S038 are the same as those in the first embodiment, and therefore, 
descriptions thereof are omitted. In the following, the processing in step S038 will be described in detail with reference 
to Figure 50. 

35 [0595] In step S038, as described above, first, the calculator 205 adds the correcting perturbation model's body 
horizontal position Xc calculated as described later in the last-time control cycle (time t-At) to the instantaneous value 
(provisional instantaneous value determined in the control cycle containing the present time t) of the desired body 
horizontal position for the simplified model gait determined in step S032 in Figure 13 as described above, thereby 
determining the corrected desired body horizontal position. Besides, the calculator204 adds the correcting perturbation 

40 model's body posture angle ec calculated as described later in the last-time control cycle (time t-At) to the instantaneous 
value (provisional instantaneous value determined in the control cycle containing the present time t) of the desired 
body posture angle forthe simplified model gait determined in stepS032 in Figure 13, thereby determining the corrected 
desired body posture angle. Then, the corrected desired body horizontal position and the corrected desired body pos- 
ture angle are output as final desired instantaneous values of the body horizontal position and the body posture angle, 

45 respectively. 

[0596] That is, the corrected desired body horizontal position and the corrected desired body posture angle are 
determined by the formulas 24 and 25, respectively. 

[0597] Then, the instantaneous values of the movement variables including the desired center-of-gravity position, 
the desired foot position/posture and the desired arm posture for the simplified model gait determined as described 

50 above, the corrected desired body horizontal position and the corrected desired body posture angle, and the instan- 
taneous value of the desired ZMP are input to the inverse dynamics full mode! 201 : thereby calculating the floor reaction 
force's horizontal component and the floor reaction force's moment about the desired ZMP which are in balance with 
the movement represented by the input movement variables (that is, which are produced for the movement by the 
inverse full model 201 ). Therefore, in this embodiment, in addition to the body horizontal position and the body posture 

55 angle for the simplified model, the correcting perturbation model's body horizontal position Xc and the correcting per- 
turbation model's body posture angle Be are input to the inverse full model 201 . In the following, as in the first embod- 
iment, the floor reaction force's horizontal component and the floor reaction force's moment calculated by the inverse 
full model 201 are referred to as a full-model's floor reaction force's horizontal component Ffull and a full-model's floor 
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reaction force's moment Mfull, respectively. 

[0598] The full-model's floor reaction force's horizontal component Ffull and the full-model's floor reaction force's 
moment Mfull are output as a corrected desired floor reaction force's horizontal component (final desired instantaneous 
value of the floor reaction force's horizontal component at the present time t) and a corrected desired floor reaction 
5 force's moment (final desired instantaneous value of the floor reaction force's moment at the present time t) , respec- 
tively. 

[0599] Thai is, the corrected desired floor reaction force's horizontal component and the corrected desired floor 
reaction force's moment are determined by the following formulas and output. 

10 

corrected desired floor reaction force's horizontal component 
- full model's floor reaction force's horizontal component 

Ffull formula 48 



corrected desired floor reaction force's moment = full-model' s 
OQ floor reaction force's moment Mfull formula 49 

[0600] As can be seen from the processing described above, in this embodiment, the full model gait is equivalent to 
the simplified model gait additionally incorporating a behavior of the perturbation model 202 for correcting body hori- 
zontal positions and a behavior of the perturbation model 203 for correcting body posture angles. Thus, the following 
25 formulas hold. However, the simplified model's floor reaction force's moment and the simplified model's floor reaction 
force's horizontal component are the moment component and the translation force's horizontal component, respectively, 
of the floor reaction force produced by the movement with the simplified model gait which is calculated using the inverse 
full model 201. 

30 

fuli model's floor reaction force's moment Mfull 
= simplified model's floor reaction force's moment 
35 + moment for the perturbation model for correcting body 

horizontal positions Mp 
4-moment for the perturbation model for correcting body posture 

40 

angles Mr formula 50 



full model's floor reaction force's horizontal component 

45 

Ffull 

= simplified model's floor reaction force's horizontal 
5Q component 

4- floor reaction force's horizontal component for the 
perturbation model for correcting body horizontal positions 

55 

+ floor reaction force's horizontal component for the 
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perturbation model for correcting body posture angles Fr formula 51 

[0601] Then, the required value Mpfdmd of the moment for stabilizing the perturbation model for correcting body 
5 horizontal positions is determined by the control law 206 for the perturbation model for correcting body horizontal 
positions. The conlrol law 206 for Lhe perturbation model for correcting body horizontal positions according to this 
embodiment is set as described in Japanese Patent Application No. 2001-133621 proposed by the applicants. For 
example, the control law 206 is determined as represented by the following formula. 

10 

required value Mpfdmd of the moment for stabilizing the 
perturbation model for correcting body horizontal positions 
15 - Kpg * center-of-gravity difference + Kvg * correcting 

perturbation model's body horizontal velocity dXc/dt formula 52 

In this formula, the center-of-gravity difference is defined by the following formula. 

20 

center-of-gravity difference - full model's 
center-of-gravity horizontal position - simplified model's 

25 

center-of-gravity horizontal position formula 53 

[0602] "Kpg" and "Kvg" in the formula 52 denote gains of feedback control and the full model's center-of-gravity 
horizontal position, the simplified model's center-of-gravity horizontal position and the correcting perturbation model's 

30 body horizontal velocity dXc/dt are the instantaneous value of the center-of-gravity horizontal position for the full model 
gait, the instantaneous value of the center-of-gravity horizontal position for the simplified model gait (center-of-gravity 
horizontal position XGs calculated using the simplified model based on the instantaneous posture in the simplified 
model gait) and the correcting perturbation model's body horizontal velocity dXc/dt which are calculated in the last- 
time control cycle (time t-At). respectively. 

35 [0603] That is, the feedback quantity (manipulating quantity) for controlling the perturbation model is calculated based 
on the center-of-gravity difference obtained by subtracting the simplified model's center-of-gravity horizontal position 
from the full model's center-of-gravity horizontal position and the perturbation model's body velocity, which is one of 
state quantities of the perturbation model. Such a perturbation model's control law allows the time-average of the 
center-of-gravity difference to be controlled to substantially 0. 

40 [0604] Then, the required value Mrfdmd of the moment for stabilizing the perturbation model for correcting body 
posture angles is determinedby the control law 207 for the perturbation model for correcting body posture angles. This 
can be attained by using the same control law as in the first embodiment Therefore, as the control law 207 : the formula 
11 is used, for example. 

[0605] Then, the Min calculator 209 determines (estimates) the unlimited corrected desired floor reaction force's 
45 moment Min. As in the first embodiment, the unlimited corrected desired floor reaction force' s moment Min is the floor 
reaction force' s moment about the desired ZMP that is produced if, neglecting the limitations (the ZMP limitation 
condition and the floor reaction force's horizontal component limitation condition) , the moment Mpf for stabilizing the 
perturbation model for correcting body horizontal positions agrees with the required value Mpfdmd of the moment for 
stabilizing the perturbation model for correcting body horizontal positions, and the moment Mrf for stabilizing the per- 
50 turbation model for correcting body posture angles agrees with the required value Mrfdmd of the moment for stabilizing 
the perturbation model for correcting body posture angles. 

[0606] As in the first embodiment, the unlimited corrected desired floor reaction force's moment Min is determined 
by calculation of the formula 1 3. That is, the unlimited corrected desired floor reaction force's moment Min is determined 
by adding the required value Mrfdmd of the moment for stabilizing the perturbation model for correcting body posture 
55 angles to the required value Mpfdmd of the moment for stabilizing the perturbation model for correcting body horizontal 
positions. 

[0607] Furthermore, the Fin calculator 210 determines (estimates) the unlimited corrected desired floor reaction 
force's horizontal component Fin. As in the first embodiment, the unlimited corrected desired floor reaction force's 
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15 



20 



25 



30 



horizontal component Fin is the floor reaction force's horizontal component (equivalent to Ff ull) that is produced by the 
inverse full model 201 if, neglecting the limitations (the ZMP limitation condition and the floor reaction force's horizontal 
component limitation condition), the moment Mpf for stabilizing the perturbation model for correcting body horizontal 
positions agrees with the required value Mpfdmd of the moment for stabilizing the perturbation model for correcting 
body horizontal positions, and the moment Mrf for stabilizing the perturbation model for correcting body posture angles 
agrees with the required value Mrfdmd of the moment for stabilizing the perturbation model for correcting body posture 
angles. 

[0608] Unlike the first embodiment, the unlimited corrected desired floor reaction force's horizontal component Fin 
is determined by the following formula. 

unlimited corrected desired floor reaction force's horizontal 

component Fin 
= full model's floor reaction force's horizontal component 
Ffull 
+ 1/h 

* (required value of the moment for stabilizing the 
perturbation model for correcting body horizontal positions 
Mpfdmd 

- moment for stabilizing the perturbation model for correcting 

body horizontal positions Mpf formula 54 



[0609] Here, as the moment Mpf for stabilizing the perturbation model for correcting body horizontal positions, the 
last-time value (at the time t-At) is used. That is, the difference between the required value Mpfdmd of the moment for 
stabilizing the perturbation model for correcting body horizontal positions and the moment Mpf for stabilizing the per- 

35 turbation model for correcting body horizontal positions is determined, and the increment of the full-model's floor re- 
action force's horizontal component Ffull due to increasing the input to the perturbation model for correcting body 
horizontal positions by the difference is estimated by dividing the difference by the body translation mode floor reaction 
force ratio h. Furthermore, the full-model's floor reaction force's horizontal component Ffull is added to the result, 
thereby estimating the unlimited corrected desired floor reaction force's horizontal component Fin. 

40 [0610] Proofs that the unlimited corrected desired floor reaction force's moment Min is determined (estimated) by 
the formula 13 and that the unlimited corrected desired floor reaction force's horizontal component Fin is determined 
(estimated) by the formula 54 will be described later. 

[061 1 ] Then, by applying the limitations to the unlimited corrected desired floor reaction force's moment Min and the 
unlimited corrected desired floor reaction force's horizontal component Fin, the limiter means (limitation processor 21 1 ) 
45 similar to that in the first embodiment determines the limited corrected desired floor reaction force's moment Mltd (about 
the desired ZMP) and the limited corrected desired floor reaction force's horizontal component Fltd in such a manner 
that the limitations (the ZMP limitation condition and the floor reaction force's horizontal component limitation condition) 
are satisfied. This procedure is performed in the same manner as in the first embodiment. 

[0612] As described later, the corrected desired floor reaction force's moment substantially agrees with the limited 
so corrected desired floor reaction force's moment Mltd, and the corrected desired floor reaction force's horizontal com- 
ponent substantially agrees with the limited corrected desired floor reaction force's horizontal component Fltd. There- 
fore, if the limited corrected desired floor reaction force's moment Mltd and the limited corrected desired floor reaction 
force's horizontal component Fltd are determined as described above, the corrected desired floor reaction force's 
moment and the corrected desired floor reaction force's horizontal component substantially satisfy the ZMP limitation 
55 condition and the floor reaction force's horizontal component limitation condition. 

[0613] Then, an Mpf calculator 215 determines the moment Mpf for stabilizing the perturbation model for correcting 
body horizontal positions. More specifically, the full-model's floor reaction force's horizontal component Ffull is sub- 
tracted from the limited corrected desired floor reaction force's horizontal component Fltd, the resulting value is multi- 
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plied by a gain Kc, the resulting value is integrated by an integrator 215a, and the resulting integral value is further 
multiplied by the body translation mode floor reaction force ratio h. thereby determining the moment Mpf for stabilizing 
the perturbation model for correcting body horizontal positions. That is ; the moment Mpf for stabilizing the perturbation 
model for correcting body horizontal positions is determined by the following formula. 

Mpf = h * jKc(Fltd - Ffull)dt formula 55 

[0614] Then, the Mrf calculator 214 determines the moment Mrf for stabilizing the perturbation model for correcting 
body posture angles by subtracting the moment Mpf for stabilizing the perturbation model for correcting body posture 
angles from the limited corrected desired floor reaction force's moment Mltd. That is f the moment Mrf for stabilizing 
the perturbation model for correcting body posture angles is determined by the formula 21 . 

[0615] Furthermore, the floor reaction force's moment Mr for the perturbation model for correcting body posture 
angles is determined by the formula 23. That is. the moment Mrf for stabilizing theperturbation modelforcorrecting body 
posture angles, which is an output from the Mrf calculator 214, is determined, in itself, as the floor reaction force's 
moment Mr for the perturbation model for correcting body posture angles. 

[0616] Then, an Merr calculator 21 6 calculates a full-model's floor reaction force's moment error Merr defined by the 
following formula. 

full-model's floor reaction force's moment error Merr 
= full-model's floor reaction force's moment Mfull - 
limited corrected desired floor reaction force's moment Mltd formula 56 

[0617] Then, an Mp calculator 217 determines the floor reaction force's moment Mp for the perturbation model for 
correcting body horizontal positions in accordance with the following formula. 

Mp = Mpf - / Km*Merr dt formula 57 

[0618] That is, an integrator 217a integrates the full-model's floor reaction force's moment error Merr multiplied by 
an integral gain Km and inverts the sign of the resulting integral value. The output from the integrator 217a is added 
to the moment Mpf for stabilizing the perturbation model for correcting body horizontal positions, thereby determining 
the floor reaction force's moment Mp for the perturbation model for correcting body horizontal positions. 
[061 9] Then , the floor reaction force's moment Mp for the perturbation model for correcting body horizontal positions 
is input to the perturbation model 202 for correcting body positions, and the correcting perturbation model's body 
position Xc in balance with the input floor reaction force's moment is calculated. 

[0620] In addition, the floor reaction force's moment Mr for the perturbation model for correcting body posture angles 
is input to the perturbation model 203 for correcting body posture angles, and the correcting perturbation model's body 
posture angle 6c in balance with the input floor reaction force's moment is calculated. 

[0621 ] The correcting perturbation model's body position Xc, the correcting perturbation model' s body posture angle 
Be and the moment Mpf for stabilizing the perturbation model for correcting body horizontal positions thus determined 
are used as the last-time values in the next-time control cycle (time t+At). 

[0622] The other configurations and processes are the same as those in the first embodiment. 

[0623] Now, that the full-model's floor reaction force's moment Mfull substantially agrees with the limited corrected 

desired floor reaction force's moment Mltd will be described. 

[0624] It is assumed that the input to the inverse dynamics full model (inverse full model) 201 is the gait movement, 
the output thereof is the full-model's floor reaction force's moment, and the transfer function from the input to the output 
is denoted by 1/G(S). 

[0625] It is assumed that the input to the simplified model 200 is the floor reaction force's moment about the desired 
ZMP, the output thereof is the gait movement, and the transfer function from the input to the output is the inverse 
function G(S) of the transfer function of the inverse dynamics full model 201 . 

[0626] However, since the simplified model 200 contains an error due to modeling, the output is represented by the 
following formula. 
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output - G (input) + G(d) formula 58 

[0627] In this formula, character d denotes a modeling error of the simplified model 200. if the simplified model 200 
5 is exactly the inverse function of the inverse dynamics full model 201 , the modeling error d is 0. However, typically, the 
modeling error d is not 0 because the simplified model involves approximation. 

[0628] The transfer function from the input to the output (gait perturbation) of the perturbation model 202 for correcting 
body horizontal positions and the perturbation model 203 for correcting body posture angles is denoted by Gm(S). 
[0629] If Figure 50 is redrawn using these transfer functions, Figure 51 results. In Figure 51, an estimated floor 
10 reaction force's moment modeling error value destm is equivalent to the integral of the output of the integrator 217a 
of tho Mp calculator 21 7. that is, the full-model's floor reaction force's moment error Merr multiplied by the gait (-Km) 
(the same holds true for Figures 52 to 57 described later). 

[0630] Furthermore, it is assumed that the perturbation model 202 for correcting body horizontal positions and the 
perturbation model 203 for correcting body posture angles have a high approximation precision, and the following 
15 formula holds approximately. 



Gm(S) = G(S) formula 59 

20 [0631] In this case, Figure 51 can be approximated by Figure 52. 

[0632] If Figure 52 is transformed to determine a transfer function from the limited corrected desired floor reaction 
force's moment Mltd to the full-model's floor reaction force's moment error Merr, the transfer function equals to 0. That 
is, the full-model' s floor reaction force's moment error Merr is not affected by the limited corrected desired floor reaction 
force's moment Mltd. 

25 [0633] In addition, if Figure 52 is transformed to determine a transfer function from the modeling error d to the full- 
model's floor reaction force's moment error Merr, the following formula results. 

Merr = S/Km/(S/Km-»-1 )*d formula 60 

30 

[0634] That is, as shown in Figure 53, the full-model's floor reaction force's moment error Merr is equivalent to the 
modeling error having passed through a low cut filter having a cutoff angular frequency equal to the gain Km [rad/s] of 
the integrator 217a. 

[0635] Generally, assuming the gait cycle as a reference frequency, most of the frequency component of the modeling 
35 error d is the third harmonic or lower. Therefore, if the integrator 21 7a has a sufficiently large gain Km, the full-model's 
floor reaction force's moment error Merr is substantially 0. 

[0636] Thus, the left side of the formula 56 equals to 0, and therefore, the full-model's floor reaction force's moment 
Mfull substantially agrees with the limited corrected desired floor reaction force's moment Mltd. 

[0637] Now, that the full-model's floor reaction force Ffull substantially agrees with the limited corrected desired floor 
40 reaction force's moment Fitd will be described. 

[0638] It is defined that the input to the inverse dynamics full model 201 is the body horizontal position, the output 
thereof is the full-model's floor reaction force's horizontal component, and the transfer function from the input to the 
output is denoted by 1/Gp(S). 

[0639] The floor reaction force's horizontal component forthe simplified model calculated using the inverse full model 
45 201 is referred to as a simplified model's gait floor reaction force's horizontal component Fs. 

[0640] According to this definition, if the input to the simplified model 200 is the simplified model's gait floor reaction 
force's horizontal component Fs and the output of the simplified model 200 is the simplified model's body horizontal 
position, the transfer function from the input to the output is represented as Gp(S). That is, the following formula holds. 

50 

body horizontal position = Gp(S) * Fs formula 61 

[0641] In addition, since the floor reaction force's horizontal component for the perturbation model 203 for correcting 
body posture angles is always 0, if the output of the perturbation model 203 for correcting body posture angles is input 
55 to the inverse dynamics full model 201 , the full-model's floor reaction force' s horizontal component is not affected by 
that. That is, the transfer function from the input of the perturbation model 203 for correcting body posture angles to 
the full-model's floor reaction force's horizontal component equals to 0. 
[0642] If Figure 50 is redrawn using these relationships, Figure 54 results. 
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[0643] As described above, Gm(S) is the transfer function from the input to the output (perturbation of the gait) of 
the perturbation model 202 for correcting body horizontal positions and the perturbation model 203 for correcting body 
posture angles. 

[0644] Further transforming Figure 54 results in Figure 55. 
5 [0645] Gm(S)/Gp(S) in Figure 55 denotes the transfer function from the floor reaction force's moment Mp for the 
perturbaLion model for correcting body horizontal positions to Lhe floor reaction force's horizontal component Fp. Gm 
(S)/Gp(S) is derived from the formulas a19 and a20 by eliminating Xc from the formulas and expressed by the following 

formula. 

10 

Gm(S)/Gp(S) = 1/h * S2/(S2 - 1/h/mb*Fbz) formula 64 

Here, "S2" represents the square of S. 

[0646] While the perturbation model 202 for correcting body horizontal positions represented by the formula 64 is a 
15 diverging system, it has a low time constant of divergence. For example, a robot having a height nearly equal to that 
of a human being has a time constant of divergence of about 3 [rad/sj. That is the correcting perturbation model's 
body horizontal position Xc varies slowly. 

[0647] Besides, from the formulas a1 9 and a20 ; the following formula results. 

20 

Fp - 1/h * Xc * Fbz + 1/h * Mp formula 65 

[0648] As with the correcting perturbation model's body horizontal positionXc, most of the body floor reaction force's 
vertical component Fbz is typically the third harmonic or lower, assuming the gait cycle as a reference frequency. 
25 [0649] Therefore, if the integrator 21 5a of the Mpf calculator 21 5 has a sufficiently large gain Kc, the response speed 
of the closed loop system shown in Figure 55 is sufficiently higher than the variation frequency of the first term in the 
right side of the formula 65. Thus, the first term in the right side of the formula 65 can be considered as a drift of the 
floor reaction force's horizontal component caused by the correcting perturbation model's body horizontal position Xc. 
Given that the drift is denoted by d1 , the formula 65 can be approximated by the following formula. 

30 

Fp = d1 + 1/h * Mp formula 66 

[0650] Therefore, Figure 55 can be transformed to Figure 56 in an approximate manner. 
35 [0651] Now, a full-model's floor reaction force's horizontal component error Ferr is defined by the following formula. 

full-model's floor reaction force's horizontal component 
40 error Ferr 

= full model's floor reaction force's horizontal 
component Ffull - limited corrected desired floor reaction 

45 

force's horizontal component Fltd formula 67 

[0652] That is, the difference between the full-model's floor reaction force's horizontal component Ffull and the limited 
corrected desired floor reaction force's horizontal component Fltd is defined as the full-model's floor reaction force's 
50 horizontal component error Ferr. 

[0653] If Figure 56 is transformed in regard to the full-model's floor reaction force's horizontal component error Ferr, 
Figure 57 results. 

[0654] Thus, the following formula results. 

55 

Ferr =r S/Kc(S/Kc + 1) * (Fs - 1/h * destm - Fltd + d1) formula 68 

[0655] That is, the full-model's floor reaction force's horizontal component error Ferr is equivalent to (Fs - 1/h * destm 
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- Fltd + d1) having passed through a low cut filter having a cutoff frequency of Kc [rad/s]. 

[0656] Assuming the gait cycle as a reference frequency, most of each term in (Fs - 1/h * destm - Fltd + d1) is the 
third harmonic or lower. Therefore., if the gain Kc is sufficiently large, the full-model's floor reaction force's horizontal 
component error Ferr is approximately 0. 

5 [0657] Thus, the left side of the formula 67 equals to 0, and therefore, the full-model' s floor reaction force's horizontal 
component Ffull substantially agrees with the limited corrected desired floor reaction force's horizontal component Fltd. 
[0658] The unlimited corrected desired floor reaction force's moment Min is, according to the definition thereof, equal 
to the full-model' s floor reaction force's moment Mfull resulting when the moment Mpf for stabilizing the perturbation 
model for correcting body horizontal positions agrees with the required value Mpfdmd of the moment for stabilizing the 

10 perturbation model for correcting body horizontal positions, and the moment Mrf for stabilizing the perturbation model 
for correcting body posture angles agrees with the required value Mrfdmd of the moment for stabilizing the perturbation 
model for correcting body posture angles. 

[0659] Since the formula 21 always holds in the second embodiment, the value of the full-model's floor reaction 
force's moment Mltd in the above-described case is determined by substituting Mpfdmd and Mrfdmd for Mpf and Mrf, 
15 respectively, in the formula 21 . 

That is, the following formula holds. 



20 



35 



50 



Mltd = Mpfdmd + Mrfdmd formula 69 



[0660] As described above, the full-model's floor reaction force's moment Mfull always substantially agrees with the 
limited corrected desired floor reaction force's moment Mltd. Therefore, the value of the unlimited corrected desired 
floor reaction force's moment, that is, the full-model's floor reaction force's moment Mfull in the above-descrioed case 
is determined by the formula 13. 
25 [0661] From Figure 56, the approximate relation described by the following formula is derived. 

Ffull - 1/h * Mpf + Fs + d1 - 1/h * destm formula 71 

30 [0662] If the formula 71 holds at a certain instant, at the instant, the unlimited corrected desired floor reaction force's 
horizontal component Fin, which is the full-model's floor reaction force's horizontal component Ffull in the case of where 
the moment Mpf is changed to the required value Mpfdmd of the moment for stabilizing the perturbation model for 
correcting body horizontal positions, is determined by the following formula. 



Fin = 1/h * Mpfdmd + Fs + d1 - 1/h * destm formula 72 



[0663] Since the transfer function from Mpf to (Fs + d1 - 1/h * destm) includes no feedthrough term, an instantaneous 
change of the value Mpf to Mpfdmd has no instantaneous effect on the term (Fs + d1 - 1/h * destm). Therefore, the 
40 terms (Fs + dO - 1/h * destm) in the formulas 71 and 72 are the same value. 

[0664] Thus, eliminating the term (Fs + d1 - 1/h * destm) from the formulas 71 and 72 results in the formula 54. 
[0665] Now, a case where both the floor reaction force's horizontal component and the floor reaction force's moment 
are not limited, that is, a case where Fin = Fltd and Min = Mltd will be described. 

[0666] Since Fin-Fltd, as can be seen from Figure 50, the required value Mpfdmd of the moment for stabilizing the 
45 perturbation model for correcting body horizontal positions and the moment Mpf for stabilizing the perturbation model 
for correcting body horizontal positions are related to each other as follows. 



Mpf = 1/(S/Kc + 1 ) * Mpfdmd formula 73 



[0667] That is, the moment Mpf for stabilizing the perturbation model for correcting body horizontal positions equals 
to the required value Mpfdmd of the moment for stabilizing the perturbation model for correcting body horizontal posi- 
tions that has passed through a first-order delay low-pass filter having a time constant of 1 /Kc. Therefore, if the integral 
gain is sufficiently large, the moment Mpf for stabilizing the perturbation model for correcting body horizontal positions 
55 substantially agrees with the required value Mpfdmd of the moment for stabilizing the perturbation model for correcting 
body horizontal positions. Thus, the body horizontal position in the perturbation model 202 forcorrecting body horizontal 
positions can be appropriately stabilized. Thus, the body horizontal position of the corrected gait can be appropriately 
prevented from diverging. 
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[0668] A digitization according to a backward difference method results in the following formula. 



current-time Mpf = last-time Mpf + (AT/(T+AT)) * (Mpfdmd - 



5 



last-time Mpf) 



formula 74 



Here : "T" denotes a time constant, and T = 1/Kc. 

[0669] Therefore, in particular, if the value Kc increases infinitely (if the time constant T is reduced to 0), the moment 
w Mpf for stabilizing the perturbation model for correcting body horizontal positions precisely agrees with the required 
value Mpfdmd of the moment for stabilizing the perturbation model for correcting body horizontal positions. 
[0670] In addition, since Fin = Fltd and Min = Mltd, considering the factthatthe required value Mpfdmd of the moment 
for stabilizing the perturbation model for correcting body horizontal positions substantially agrees with the moment Mpf 
for stabilizing the perturbation model for correcting body horizontal positions as described above, the following formula 
15 holds (in an approximate manner) as can be seen from Figure 50. 



20 [0671] That is, the moment Mrf for stabilizing the perturbation model for correcting body posture angles exactly or 
substantially agrees with the required value Mrfdmd of the moment for stabilizing the perturbation model for correcting 
body posture angles. Thus, the body posture angle in the perturbation model 203 for correcting body posture angles 
can be appropriately stabilized. Thus, the body posture angle of the corrected gait can be appropriately prevented from 
diverging. 

25 [0672] Finally, a case where at least one of the floor reaction force's horizontal component and the floor reaction 
force's moment is !imited : that is, a case where Fin * Fltd or Min * Mltd will be described. 

[0673] In this case, as described earlier concerning the limiter means, the limiter means (limitation processor 211) 
preferentially makes the moment Mrf for stabilizing the perturbation modelfor correcting body posture angles agree 
with the required value Mrfdmd of the moment for stabilizing the perturbation model for correcting body posture angles 
so as closely as possible. Therefore, at least the correcting perturbation model's body posture angle 9c can be preferen- 
tially stabilized to the extent possible, and then, the correcting perturbation model's body horizontal position Xc can be 
stabilized as appropriately as possible. 

[0674] As described above, according to the second embodiment, the corrected desired movement according to the 
simplified model gait corrected using the perturbation models 202 and 203 is input to the inverse full model 201 , and 

35 the floor reaction force calculated by the inverse full model 201 is adopted as the corrected desired floor reaction force. 
Therefore, the corrected gait comprising the corrected desired movement (including the corrected desired body posi- 
tion/posture and the like) and the corrected desired floor reaction force (including the corrected desired floor reaction 
force's horizontal component and the corrected desired floor reaction force's moment) is generated so as to satisfy the 
dynamical equilibrium condition (that the moment applied about the desired ZMP by the resultant force of gravity and 

40 the inertial force is 0). 

[0675] Furthermore, there is provided a feedback loop which includes the perturbation models 202 and 203 for cor- 
recting the body horizontal position and body posture angle, respectively, corrects the desired body horizontal position 
and the desired body posture angle of the simplified model gait based on the outputs of the perturbation models, and 
receives the manipulating quantities to be sent to the perturbation models 202 and 203 so that the limited corrected 

45 desired floor reaction force's horizontal component Fltd and the limited corrected desired floor reaction force's moment 
Mltd, which are output from the limiter means (limitation processor 211), agree with the corrected desired floor reaction 
force's horizontal component and the corrected desired floor reaction force's moment, respectively. In addition, the 
limiter means (limitation processor 201 ) provides the limited corrected desired floor reaction force's horizontal compo- 
nent Fltd and the limited corrected desired floor reaction force's moment Mltd which don't exceed their respective 

50 allowable ranges (thefloor reaction force's horizontal component allowable range and the ZMP allowable range). There- 
fore, the corrected desired floor reaction force's horizontal component and the corrected desired floor reaction force's 
moment are prevented from exceeding their respective allowable ranges, and a corrected gait having a high stability 
margin and hardly causing slipping is provided. 

[0676] In addition, there are used the control laws for determining required values of the manipulating quantities that 
55 are to be input or additionally input to the perturbation models 202 and 203 to stabilize the perturbation models 202 
and 203, the limiter means provides the limited corrected desired floor reaction force's horizontal component Fltd and 
the limited corrected desired floor reaction force's moment Mltd which fall within their respective allowable ranges, and 
the manipulating quantities to be input to the perturbation models 202 and 203 are determined to be as close as possible 



Mrf - Mrfdmd 



formula 75 
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to the required values thereof determined by the control laws. Therefore, the stability of the perturbation models 202 
and 203 are enhanced, and the corrected gait is prevented from diverging. 

[0677] In addition, stabilization of the body posture angle (stabilization of the perturbation model for correcting body 
posture angles) is given a higher priority than stabilization of the body horizontal position (stabilization of the perturbation 

5 model for correcting body horizontal positions) in the case where at least one of the limited corrected desired floor 
reaction force's horizontal component Flld and the limited corrected desired floor reaction force's moment Mild may 
exceed the allowable ranges if the required values of the manipulating quantities determined by the control laws them- 
selves are input to the perturbation models 202 and 203. Therefore, the stability of the body posture angle is enhanced, 
and the gait is corrected to provide a more natural posture. 

10 [0678] Now, associations of the second embodiment described above with the present invention will be described. 
The second embodiment is associated with the first to tenth and sixteenth to twenty-second implementations of the 
present invention (except for the seventeenth implementation and the implementation(s) based essentially on the sev- 
enteenth implementation. The same holds true for the following description unless the seventeenth implementation is 
mentioned in particular). In this case, the allowable range setting means according to the first to tenth and sixteenth 

15 to twenty-second implementations is associated with the processings in steps S030 and S036 in the flowchart in Figure 
13, and regarding the translation floor reaction force's horizontal component and the ZMP (true ZMP) as limitation- 
target quantities, the allowable ranges thereof are set. In addition, the provisional instantaneous value determining 
means according to the first to tenth and sixteenth to twenty-second implementations is associated with the processing 
in step S032 (calculation of the simplified model gait's instantaneous values) in the flowchart in Figure 13. In this case. 

20 in particular, the instantaneous value of the body position/posture, the instantaneous value of the floor reaction force's 
horizontal position, the desired ZMP, and the instantaneous value of the floor reaction force's moment about the desired 
ZMP (= 0) are determined as provisional instantaneous values. The model calculation means according to the first to 
tenth and sixteenth to twenty-second implementations is associated with the processings of determining the full-model's 
floor reaction force's horizontal component Fful! and the full-model's floor reaction force's moment Mfull as model floor 

25 reaction force instantaneous values using the inverse full model 201 , which is a dynamics model (in particular, process- 
ing of determining Mfull). In addition, the desired instantaneous value determining means according to the first to tenth 
and sixteenth to twenty-second implementations is associated with the processing in step S038 in the flowchart in 
Figure 13. In this case, the full-model' s floor reaction force' s moment Mfull is equivalent to the difference between the 
model floor reaction force instantaneous value and the provisional instantaneous value of the desired floor reaction 

30 force. As the desired instantaneous value of the desired floor reaction force in the third implementation, the corrected 
desired floor reaction force' s moment or corrected desired floor reaction force's horizontal component in the case 
where the desired ZMP is the point of application is determined. However, in this case, according to the sixteenth 
implementation , the correcting perturbation model's body horizontal position Xc and the correcting perturbation model's 
body posture angle 6c are additionally input to the inverse full model 201 as correction quantities for the provisional 

35 instantaneous values of the desired movement. According to the twenty-second implementation, the corrected desired 
floor reaction force's moment and the corrected desired floor reaction force's horizontal component are obtained as 
outputs (model floor reaction force instantaneous value) of the inverse full model 210. 

[0679] Furthermore, the second embodiment includes the perturbation model 202 for correcting body horizontal 
positions and the perturbation model 203 for correcting body posture angles, which are perturbation models in the 

^0 fourth to tenth and eighteenth to twenty-second implementations (except for the implementation(s) based essentially 
on the seventeenth implementation). In this case, as perturbation model manipulating quantities, the moment Mp for 
the perturbation model for correcting body horizontal positions and the moment Mr for the perturbation model for cor- 
recting body posture angles are determined, and input to the perturbation models 202 and 203. thereby determining 
the correcting perturbation model's body horizontal position Xc and the correcting perturbation model's body posture 

45 angle Be as correction quantities for the desired movement. In addition, the output of the integrator 21 7a (input to the 
Mp calculator 214) which is determined depending on the full model's floor reaction force's moment Mfull (which is 
equivalent to the difference between the model floor reaction force instantaneous value and the provisional instanta- 
neous value of the desired floor reaction force) is involved as a first manipulating quantity component of the perturbation 
model manipulating quantity, and themoment Mpf for stabilizing the perturbation model for correcting the body horizontal 

50 position and the moment Mrf for stabilizing the perturbation model for correcting body posture angles (which equals 
to Mr in the second embodiment) are involved as second manipulating quantity components of the perturbation model 
manipulating quantity. In addition, the required value Mpfdmd of the moment for stabilizing the perturbation model for 
correcting body horizontal positions and the required value Mrfdmd of the moment for stabilizing the perturbation model 
for correcting body posture angles are used as required values of the perturbation model manipulating quantities. In 

55 addition, as estimated values of the limitation-target quantities in the eighteenth to twentieth implementations, the 
unlimited corrected desired floor reaction force's moment Min and the unlimited corrected desired floor reaction force's 
horizontal component Fin are determined by the Min calculator 209 and the Fin calculator 210, respectively, and as 
limitation-target quantities having been limited, the limited corrected desired floor reaction force's moment Mltd and 
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the limited corrected desired floor reaction force's horizontal component Fltd are determined by the limitation processor 
21 1 Besides, the "predetermined part" of the robot according to the eighth implementation refers to the body 24 of the 
robot 1 . 

[0680] As in the first embodiment, the floor reaction force's moment used in the second embodiment may be appro- 
5 priately converted into a ZMP using the desired floor reaction force's vertical component. 

[0681 J In addition, the seventeenth implementation involves no required value for the perturbation models, and the 
embodiment in this case can be provided by setting both the values Mpfdmd and Mprdmd in the second embodiment 
to 0. Thus, the embodiment concerning the seventeenth implementation and the implementation(s) based essentially 
thereon is provided. Associations of this embodiment with the seventeenth implementation or the like are the same as 
10 the associations concerning the second embodiment. 

[0682] Now, a third embodiment of the present invention will be described. A correction method for a device according 
to the third embodiment is of a full model feedback type. Furthermore, the method uses the inverse dynamics full model 
(inverse full model) . corrects an input of the simplified model gait and uses no perturbation model. 
[0683] Figure 58 is a functional block diagram for illustrating an operation of the device according to the third em- 
15 bodiment, specifically, the gait correction method in step S038 in the flowchart in Figure 1 3. In Figure 58, same functional 
sections as those in Figure 50 concerning the second embodiment are assigned the same reference numerals as those 
in Figure 50. 

[0684] In the description of this embodiment, instead of theterm "required value Mpfdmd of the moment for stabilizing 
the perturbation model for correcting body horizontal positions", the term "required value Mpfdmd of the body horizontal 

20 position stabilizing moment" is used. This is because this embodiment uses no perturbation model, and the moment 
Mpfdmd is used for stabilizing the body horizontal position of the simplified model 200. Similarly, instead of the term 
"required value Mrfdmd of the moment for stabilizing the perturbation model for correcting body posture angles", the 
term "required value Mrfdmd of the body posture angle stabilizing moment" is used. Similarly, the term "body horizontal 
position stabilizing moment Mpf" is used instead of the term "moment Mpf for stabilizing the perturbation model for 

25 correcting body horizontal positions", the term "body posture angle stabilizing moment Mrf" is used instead of the term 
"moment Mrf for stabilizing the perturbation model for correcting body posture angles", the term "simplified model's 
body posture angle correcting moment Mr 11 is used instead of the term "moment Mr for the perturbation model for 
correcting body posture angles", and the term "simplified model's body horizontal position correcting moment Mp" is 
used instead of the term "moment Mp for the perturbation model for correcting body horizontal positions". 

30 [0685] However, the simplified model 200 shown in Figure 58 is not simply a dynamics model but represents the 
process from steps S010 to S034 in Figure 13 described above, that is, calculation (determination) of the simplified 
model gait's instantaneous values. In the processing of calculation (determination) of the current time gait's instanta- 
neous values (simplified model gait's instantaneous vaiues) in step S032, after the gait's instantaneous values are 
generated in such a manner that no floor reaction force's moment is produced about the desired ZMP (the corrected 

35 desired floor reaction force's moment is 0) as described concerning the first embodiment, a perturbation movement in 
the body rotation mode which causes the moment Mr for the perturbation model for correcting body posture angles 
(last time value) which is equivalent to the moment Mr for the perturbation model for correcting body posture angles 
described concerning the second embodiment is added thereto, and a perturbation movement in the body translation 
mode which causes the simplified model's body hori zontal position correct! ngmoment Mp (last time value) which is 

40 equivalent to the moment Mp for the perturbation model for correcting body horizontal positions described concerning 
the second embodiment is added thereto. Thus, the instantaneous gait values output from the simplified model 200 
are corrected. 

[0686] More specifically, in the processing in step S032 in Figure 13 according to this embodiment, in step S914 in 
Figure 37 which is a subroutine processing thereof, a body horizontal acceleration (d2Xb/dt2) is determined based on 

45 an assumption that the second term in the right side is equal to Mp (last time value), that is, based on a formula 
represented as Mp = mf* (Zb - Zzmp) * (d2Xb/dt2), the body horizontal acceleration (d2Xb/dt2) is added to the body 
horizontal acceleration determined by the simplified model 200 as a perturbation component, and the resulting body 
horizontal acceleration is integrated two times with respect to a period from the start of the current time gait to the 
present timet, thereby determining the instantaneous value of the body horizontal position at the present timet. Besides, 

50 in step S914 in Figure 37, a body posture angular acceleration (d29b/dt2) determined based on an assumption that 
the seventh term in the right side of the formula a10 is equal to Mr (last time value) , that is, based on a formula 
represented as Mr = J*d2Bb/dt2 is added to the body posture angular acceleration determined by the simplified model 
200 as a perturbation component, and the resulting body posture angular acceleration is integrated two times with 
respect to a period from the start of the current time gait to the present time t, thereby determining the instantaneous 

55 value of the body posture angle at the present time t. 

[0687] In Figure 58, the sections following the simplifiedmodel 200 are associated with the processing in step S038. 
The points other than the processings in steps S032 and S038 are the same as those in the first embodiment, and 
therefore, descriptions thereof are omitted. In the following, the processing in step S038 will be described in detail with 
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reference to Figure 58. 

[0688] In step S038, first, as the corrected desired body horizontal position (final desired instantaneous value of the 
body horizontal position at the time t) , the simplified model's body horizontal position corrected based on the simplified 
model's body horizontal position correcting moment Mp (specifically, last time value in the control cycle including the 
5 time (t-At)) in step S030 as described above is output. In addition, as the corrected desired body posture angle (final 
desired instanLaneous value of the body posture angle at the lime t) , the simplified model's body posture angle cor- 
rected based on the moment Mr for the perturbation model for correcting body posture angles (specifically, last time 
value in the control cycle including the time (t-At)) in step S030 as described above is output. 

[0689] That is, the corrected desired body horizontal position and the corrected desired body posture angle are 
10 determined by the formulas 1 00 and 1 01 , respectively. 

corrected desired body horizontal position = simplified 
15 model's body horizontal position formula 100 

corrected desired body posture angle - simplified model's body 
0Q posture angle formula 101 

[0690] Then, the instantaneous values of the movement variables including the desired center-of-gravity position, 
the desired foot position/posture and the desired arm posture for the simplified model gait determined as described 
above, the corrected desired body horizontal position (that is, simplifiedmoder' s body horizontal position) and the 

25 corrected desired body posture angle (that is, simplified model's body posture angle), and the instantaneous value of 
the desired ZMP are input to the inverse dynamics full model (inverse full model) 201 , thereby calculating the floor 
reaction force's horizontal component and the floor reaction force's moment about the desired ZM P which are in balance 
with the movement represented by the input movement variables (that is, which are produced for the movement by 
the inverse full model 201). In the following, as in the second embodiment, the floor reaction force's horizontal com- 

30 ponent and the floor reaction force's moment thus calculated are referred to as a full-model's floor reaction force's 
horizontal component Ffull and a full-model's floor reaction force's moment Mfull, respectively. 

[0691] As in the second embodiment, the full-model's floor reaction force's horizontal component Ffull and the full- 
model's floor reaction force's moment Mfull are output as a corrected desired floor reaction force's horizontal component 
(final desired instantaneous value of the floor reaction force's horizontal component at the time t) and a corrected 
35 desired floor reaction force's moment (final desired instantaneous value of the floor reaction force's moment at the time 
t), respectively. 

[0692] Since the perturbation model for correcting body posture angles and the perturbation model for correcting 
body horizontal positions are not used in this embodiment, processings associated with the control laws for the per- 
turbation model for correcting body horizontal positions and the perturbation model for correcting body posture angles 

40 are different from those according to the second embodiment as described later. 

[0693] Except for that, after the processings, the same processings as the processings for determining the moment 
Mr for the perturbation model for correcting body posture angles and the moment Mp for the perturbation model for 
correcting body horizontal positions in the second embodiment are performed until the time to determine the moment 
Mr for the perturbation model for correcting body posture angles and the simplified model's body horizontal position 

45 correcting moment Mp. That is, the Min calculator 209, the Fin calculator 210, the limitation processor 211 (limiter 
means), the Mpf calculator 215, the Merr calculator 216, the Mrf calculator 217 (= Mr calculation unit) and the Mp 
calculator 214 performs the same processings as those in the second embodiment. 

[0694] The moment Mr for the perturbation model for correcting body posture angles and the simplified model' s 
body horizontal position correcting moment Mp are used as last time values when determining (generating) the sim- 
50 plified model gait's instantaneous values in the next time control cycle (time t+At). 

[0695] The other configurations and processings are the same as those in the second embodiment. 
[0696] In the following, a method of determining the required value Mrfdmd of the body posture angle stabilizing 
moment will be described. In this embodiment, the value Mrfdmd is determined in the Mrfdmd determinator 21 8 in the 
following manner, for example. 

55 [0697] That is, the required value Mrfdmd of the body posture angle stabilizing moment may be determined in such 
a manner that the corrected desired body posture angle follows the reference body posture angle, for example, as with 
the control law 207 for the perturbation model for correcting body posture angles. 

[0698] Alternatively, the required value Mrfdmd of the body posture angle stabilizing moment may always be set to 
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0. However, there is a possibility that the body posture angle diverge, and therefore, the body posture angle has to be 
prevented from diverging by adjusting a gait parameter (ZMPrec pattern, for example) of the next step. 
[0699] Now, a method of determining the required value Mpfdmd of the body horizontal position stabilizing moment 
will be described. In this embodiment, the value Mpfdmd is determined in the Mpfdmd determinator 21 9 in the following 
5 manner, for example. 

[0700] When Ihe robol is moving, unlike the body posture angle, the simplified model's body horizontal position 
cannot be made to follow or converge to. a arbitrarily set reference body position, because the dynamical equilibrium 
condition has to be satisfied. 

[0701] Thus, at least when the robot is moving, the required value of the body horizontal position stabilizing moment 
10 Mpfdmd is always set to 0. As described above, the corrected desired floor reaction force's moment about the desired 
ZMP substantially agrees with the required value Mpfdmd of the body horizontal position stabilizing moment, and 
therefore, in this case, the corrected desired floor reaction force's moment about the desired ZM P is always 0. However, 
since the body horizontal position tends to diverge, the body horizontal position has to be prevented from diverging by 
adjusting a gait parameter of the next step (for example, by adjusting the ZMP correction quantity pattern described 
15 concerning Figure 39 in such a manner that the body horizontal position is connected to that of the normal gait). 

[0702] When the robot stands upright, as with the body posture angle, a reference body horizontal position may be 
set, and the required value Mpfdmd of the body horizontal position stabilizing moment may be determined so that the 
corrected desired body position converges to the reference body horizontal position. 

[0703] For example, the required value Mpfdmd of the body horizontal position stabilizing moment may be determined 
20 by the following formula. 

Mpfdmd=Kpb * (corrected desired body horizontal position 
25 - reference body horizontal position) 

+ Kvb * corrected desired body horizontal velocity formula 1 1 0 

[0704] Here, the corrected desired body velocity is a time differential value of the corrected desired body position. 
30 "Kpb" and "Kpv" denote gains. 

[0705] In this embodiment, the simplified model's body horizontal position correcting moment Mp additionally input 
to the simplified mode! 200 is determined in such a manner that the full model's floor reaction force's horizontal com- 
ponent Ffull (= corrected desired floor reaction force's horizontal component) that is output from the inverse full model 
201 doesn't exceed the floor reaction force's horizontal component allowable range for gait correction. Therefore, when 
35 determining the current time gait's instantaneous values in step S032 in Figure 13, in the processing in step S912 in 
Figure 37, the body horizontal acceleration and the body posture angular acceleration are not necessarily required to 
be determined so as to prevent the floor reaction force's horizontal component Fx from exceeding the floor reaction 
force's horizontal component allowable range. Therefore, the processing in step S912 may be performed by assuming 
that Fx is always equal to Fxtmp (Fx = Fxtmp) in the processing from steps S1006 to S1012 in Figure 38. 
40 [0706] Now, associations of the third embodiment described above with the present invention will be described. The 
third embodiment is associated with the twenty-third to twenty-sixth implementations of the present invention. In this 
case, the allowable range setting means according to the twenty-third to twenty-sixth implementations is associated 
with the processings in steps S030 and S036 in the flowchart in Figure 13, and regarding the translation floor reaction 
force's horizontal component and the ZMP (true ZMP) as limitation-target quantities, the allowable ranges thereof are 
45 set. In addition, the desired floor reaction force provisional instantaneous value determining means according to the 
twenty-third to twenty-sixth implementations is associated with part of the processing in step S032 in the flowchart in 
Figure 1 3 (specifically, processings in steps S900 and S902 in Figure 37. that is, calculation of the instantaneous values 
of the desired floor reaction force's vertical component and the desired ZMP). The first model calculation means ac- 
cording to the twenty-third to twenty-sixth implementations is associated with the processings of determining the ip- 
so stantaneous values (provisional instantaneous values) of the body position/posture in steps S912 and S914 in Figure 
37 using the simplifiedmodel 200 as a first dynamics model. The second mode! calculation means according to the 
twenty-third to twenty-sixth implementations is associated with the processings of determining the full-model's floor 
reaction force's horizontal component Ffull and the full-model' s floor reaction force's moment Mfull as model floor 
reaction force instantaneous values using the inverse full model 201 as a dynamics model (in particular processing 
55 of determining Mfull). In addition, the first model input correcting means according to the twenty-third to twenty-sixth 
implementations is associated with the processing in step S038 in the flowchart in Figure 13 (except for the calculation 
for the inverse full model 201). In this case, the full-model's floor reaction force's moment Mfuil is equivalent to the 
difference between the model floor reaction force instantaneous value and the provisional instantaneous value of the 
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desired floor reaction force. In addition, the simplified model's body horizontal position correcting moment Mp and the 
simplified model's body posture angle correctingmoment Mr are determined as correction quantities of the desired floor 
reaction force and additionally input to the simplified model 200, which is the first dynamics model. Then, inputs to the 
inverse full model 201 which is the second dynamics model (that is, outputs of the simplified model 200) are determined 
5 interms of desired instantaneous values of the desired movement (corrected desired body horizontal position, corrected 
desired posture or the like) , According to the twenty-Fifth implementation, the corrected desired floor reaction force's 
moment andthe corrected desired floor reaction force's horizontal component, which are outputs of the inverse full 
model 210, are obtained as desired instantaneous values of the desired floor reaction force. Furthermore, the first 
correction quantity component according to the twenty-sixth implementation is the output of the integrator 21 7a. and 
10 the second correction quantity component is the body horizontal position stabilizing moment Mpf and the body posture 
angle stabilizing moment Mrf (which equals to Mr in the third embodiment). Furthermore, in the third embodiment, the 
required value Mpfdmd of the body horizontal position stabilizing moment and the required value Mrfdmd of the body 
posture angle stabilizing moment are used as required values of the correction quantities of the desired floor reaction 
force. In addition, as estimated values of the limitation-target quantities in the twenty-sixth implementation, the unlimited 
15 corrected desired floor reaction force's moment M in and the unlimited corrected desired floor reaction force's horizontal 
component Fin are determined by the Min calculator 209 and the Fin calculator 210, respectively, and as limitation- 
target quantities having been limited, the limited corrected desired floor reaction force's moment Mltd and the limited 
corrected desired floor reaction force's horizontal component Fltd are determined by the limitation processor 211 . 
[0707] As in the first embodiment, the floor reaction force's moment used in the third embodiment may be appropri- 
ate ately converted into a ZMP using the desired floor reaction force's vertical component. 

[0708] Now, a fourth embodiment of the present invention will be described. A correction method for a device ac- 
cording to the fourth embodiment is a combination of the methods according to the second and third embodiments. 
Figure 59 is a functional block diagram for illustrating an operation of the device according to the fourth embodiment 
of the present invention, specifically, the gait correction method in step S038 in the flowchart in Figure 13. In Figure 
25 59, same functional sections as those in the second and third embodiments are assigned the same reference numerals 
as those in Figures 57 and 58. 

[0709] According to the fourth embodiment, the perturbation model 202 for correcting body horizontal positions and 
the perturbation model 203 for correcting body posture angles are used. In addition, two distributors 220 and 221 are 
used. 

30 [0710] The distributors 220 and 221 are one-input two-output transfer blocks and determine one of the outputs ac- 
cording to the input (for example, determine one of the outputs by performing, on the input, a signal processing con- 
cerning frequency characteristics, dead-band characteristics, saturation characteristics or the like) and determine the 
other output in such a manner that the sum of the two outputs exactly or substantially agrees with the input. 
[0711] The distributor 220 receives the body posture angle correcting moment Mr, which is the difference between 

35 the limited corrected desired floor reaction force's moment Mltd and the moment Mpf for stabilizing the perturbation 
model for correcting body horizontal positions (that is, output of the Mr calculator 214) and provides a body posture 
angle correcting perturbation model input Mri that is to be input to the perturbation model 203 for correcting body 
posture angles and a simplified model's body posture angle correcting moment Mrs that is to be input to the simplified 
model 200. The body posture angle correcting perturbation model input Mri and the simplified model's body posture 

-to angle correcting moment Mrs are determined (output) in such a manner that the sum of the body posture angle cor- 
recting perturbation model input Mri and the simplified model's body posture angle correcting moment Mrs agrees with 
the body posture angle correcting moment Mr. 

[0712] More specifically, the body posture angle correcting perturbation model input Mri is determined in accordance 
with the body posture angle correcting moment Mr For example, the body posture angle correcting perturbation mcd^! 

45 input Mri is determined by performing a signal processing having dead band characteristics, saturation charact eristics 
or frequency characteristics on the body posture angle correcting moment Mr. in addition, the simplified model's body 
posture angle correcting moment Mrs is determined by subtracting the body posture angle correcting perturbation 
model input Mri from the body posture angle correcting moment Mr More specifically, according to this embodiment, 
the distributor 220 outputs a low-frequency component (direct-current component) obtained by passing the input (body 

50 posture angle correcting moment Mr) through a low-pass filter as the simplified model's body posture angle correcting 
moment Mrs and outputs a component obtained by subtracting Mrs from the input (body posture angle correcting 
moment Mr) as the body posture angle correcting perturbation model input Mri, for example. In this case, the simplified 
model's body posture angle correcting moment Mrs, which is a low-frequency component (direct-current component), 
has dead band characteristics, so that the moment Mrs is kept at a predetermined value (0, for example) if the output 

55 of the low-pass filter falls within a predetermined range centered on the predetermined value. 

[0713] The body posture angle correcting perturbation model input Mri output from the distributor 220 is input to the 
perturbation model 203 for correcting body posture angles, and the perturbation model 203 for correcting body posture 
angles determines the correcting perturbation model's body posture angle 0c. 
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[0714] The simplified model's body posture angle correcting moment Mrs, which is the other output of the distributor 
220, is input to the simplified model 200. This is equivalent to input of the simplified model's body posture angle cor- 
recting moment Mr to the simplified model 200 in the third embodiment shown in Figure 58. 

[071 5] To the distributor 221 , a value obtained by multiplying the full-model's floor reaction force's moment error Merr 
5 by the gain Km. integrating the resulting value by the integrator 217a, and inverting the sign of the resulting value is 
input. The input is equivalent to a value obtained by inverting Ihe sign of Lhe estimated floor reaction force's moment 
modeling error value deslm described concerning the second embodiment. 

[0716] As with the distributor 220 ; the distributor 221 separates the input into a simplified model's body horizontal 
position correcting moment Mps that is to be input to the simplified model 200 and an error correcting moment Me that 

10 is to be input to the perturbation model 202 for correcting body horizontal positions. More specifically, the error correcting 
moment Me is determined in accordance with the output of the integrator 217a. For example, the error correcting 
moment Me is determined by performing a signal processing having dead band characteristics, saturation character- 
istics or frequency characteristics on the output of the integrator 217a (input to the distributor 220). In addition, the 
simplified model's body posture angle correcting moment Mrs is determined by subtracting the error correcting moment 

15 Me from the output of the integrator 21 7a. More specifically, according to this embodiment, the distributor 221 outputs 
a low-frequency component (direct-current component) obtained by passing the input (output of the integrator 217a) 
through a low-pass filter as the simplified model's body horizontal position correcting moment Mps and outputs a 
component obtained by subtracting Mps from the input (output of the integrator 21 7a) as the error correcting moment 
Me. for example. In this case, the simplified model'sbody horizontal position correcting moment Mps, which is a low- 

20 frequency component (direct-current component) , has dead band characteristics, so that the moment Mps is kept at 
a predetermined value (0, for example) if the output of the low-pass filter falls within a predetermined range centered 
on the predetermined value. 

[0717] The moment Mp for the perturbation model for correcting body horizontal positions is determined by the Mp 
calculator 21 7b adding the moment Mpf for stabilizing the perturbation model for correcting body horizontal positions 
25 to the error correcting moment Me, which is an output of the distributor 221 . The moment Mp forthe perturbation model 
for correcting the body horizontal position is input to the perturbation model 202 for correcting body horizontal positions, 
and the perturbation model 202 for correcting body horizontal positions determines the correcting perturbation model's 
body horizontal position Xc. 

[0718] The simplified model body horizontal position correcting moment Mps, which is the other output of the dis- 
30 tributor 221 , is input to the simplified model 200. This is equivalent to input of the simplified model's body horizontal 
position correcting moment Mp to the simplified model 200 in the third embodiment shown in Figure 58. 
[0719] As in the third embodiment, in calculation (determination) of simplified mode! gait instantaneous values, the 
simplified model 200 first generates the gait's instantaneous values in such a manner that no floor reaction force's 
moment is produced about the desired ZMP, and then, corrects the gait's instantaneous values by adding thereto a 
35 perturbation movement in the body rotation mode which causes the simplified model's body posture angle correcting 
moment Mrs (last time value) and adding thereto a perturbation movement in the body translation model which causes 
the simplified model'sbody horizontal position correcting moment Mps (last time value). 

[0720] The other configurations and processings are the same as those in the second or third embodiment. More 
specifically, the processings by the calculators 204, 205, the Merr calculator21 6, the control law 207 forthe perturbation 
40 model for correcting body posture angles, the control law 206 forthe perturbation model for correcting body horizontal 
positions, the Min calculator 209, the Fin calculator 21 0, the limitation processor 211 and the Mpf calculator 21 5 are 
the same as those in the second embodiment. 

[0721] In this embodiment, as in the third embodiment described above, when determining the current time gait's 
instantaneous values in step S032 in Figure 13, in the processing in step S912 in Figure 37, the body horizontal 
45 acceleration and the body posture angular acceleration are not necessarily required to be determined so as to prevent 
the floor reaction force's horizontal component Fx from exceeding the floor reaction force's horizontal component al- 
lowable range. Therefore, the processing in step S91 2 may be performed by assuming that Fx is always equal to Fxtmp 
(Fx = Fxtmp) in the processing from steps S1006 to S1012 in Figure 38. 

[0722] Since the sum of the outputs agrees with the input in the distributors 220, 221 , as in the second embodiment, 
50 the corrected desired floor reaction force's moment (full-model' s floor reaction force's moment Mfull) agrees with the 
limited corrected desired floor reaction force's moment Mltd, and the corrected desired floor reaction force's horizontal 
component (full-model's floor reaction force's horizontal component) agrees with the limited corrected desired floor 
reaction force's horizontal component Fltd. Therefore, the limiter means (limitation processor 211 ) applies limitations 
to the limited corrected desired floor reaction force's moment Mltd and the limited corrected desired floor reaction 
55 force's horizontal component Fltd to prevent them from exceeding their respective allowable ranges, thereby generating 
an appropriate gait (corrected gait) that does not exceed the allowable range, as in the first to third embodiments. 
[0723] One of the outputs of each of the distributors 220, 221 may be set to 0, and the other be made to agree with 
the input. 
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[0724] If the simplified models body posture angle correcting moment Mrs output from the distributor 220 is set to 
0, and the simplified model's body horizontal position correcting moment Mps output from the distributor 221 is set to 
0. the same effect as in the second embodiment can be provided (substantially the same configuration as in the second 
embodiment is provided). 

5 [0725] If the body posture angle correcting perturbation model input Mri output from the distributor 220 is set to 0, 
and the error correcting moment Me output from the distributor 221 is set to 0. the same effect as in the third embodiment 
can be provided (substantially the same configuration as in the third embodiment is provided). 

[0726] That is, the system according to the fourth embodiment includes the systems according to the second and 
third embodiments. 

10 [0727] Alternatively, the simplifiedmodel's body posture angle correcting moment Mrs output from the distributor 220 
may be set to 0, and the error correcting moment Me output from the distributor 221 be set to 0. In this case, the 
perturbation model for correcting body posture angles can be omitted. 

[0728] Alternatively, the body posture angle correcting perturbation model input Mri output from the distributor 220 
may be set to 0 ; and the simplified model's body horizontal position correcting moment Mps output from the distributor 
15 221 be set to 0. 

[0729] Alternatively, the sum of the error correcting moment Me and the moment Mpf for stabilizing the perturbation 
model for correcting body horizontal positions may be input to a third distributor (not shown), and one of the outputs 
of the third distributor may be input to the perturbation model for correcting body horizontal positions, and the other 
output may be added to the simplified model' s body horizontal position correcting moment Mps. In this case, the 

20 simplified model's body horizontal position correcting moment Mps output from the distributor 221 may be set to 0. 
That is, the distributor 221 may be omitted, and a value obtained by multiplying the full-model's floor reaction force's 
moment error Merr by the gain Km, integrating the resulting value, inverting the sign of the resulting value and adding 
the resulting value to the moment Mpf for stabilizing the perturbation model for correcting body horizontal positions 
may be input to the third distributor. 

25 [0730] Now, associations of the fourth embodiment described above with the present invention will be described. 
. The fourth embodiment is associated with the twenty-third to twenty-fifth and twenty-seventh to thirty-ninth implemen- 
tations of the present invention (except for the thirty-fifth implementation and the implementation(s) based essentially 
on the thirty-fifth implementation. The same holds true for the following description unless the thirty-fifth implementation 
is mentioned in particular). In this case, the allowable range setting means according to the twenty-third to twenty-fifth 

30 and twenty-seventh to thirty-ninth implementations is associated with the processings in steps S030 and S036 in the 
flowchart in Figure 13, and regarding the translation floor reaction force's horizontal component and the ZMP (true 
ZMP) as limitation-target quantities, the allowable ranges thereof are set. In addition, the desired floor reaction force 
provisional instantaneous value determining means according to the twenty-third to twenty-fifth and twenty-seventh to 
thirty-ninth implementations is associated with part of the processing in step S032 in the flowchart in Figure 13 (spe- 

35 cificaliy, processings in steps S900 and S902 in Figure 37, that is, calculation of the instantaneous values of the desired 
floor reaction force's vertical component and the desired ZMP). The first model calculation means according to the 
twenty-third to twenty-fifth and twenty-seventh to thirty-ninth implementations is associated with the processings of 
determining the instantaneous values (provisional instantaneous values) of the body, position/posture in steps S912 
and S91 4 in Figure 37 using the simplified model 200 as a first dynamics model. The second model calculation means 

40 according to the twenty-third to twenty-fifth and twenty-seventh to thirty-ninth implementations is associated with the 
processings of determining the full-model's floor reaction force's horizontal component Ffull and the full-model's floor 
reaction force's moment Mfull as model floor reaction force instantaneous values using the inverse full model 201 , 
which is a second dynamics model (in particular, processing of determining Mfull). In addition, the first model input 
correcting means according to the twenty-third to twenty-fifth and twenty-seventh to thirty-ninth implementations is 

45 associated with the processing in step 8038 in the flowchart in Figure 1 3 (except for the calculation for the inverse full 
model 201 ). in this case, the full-model's floor reaction force's moment Mfull is equivalent to the difference between 
the model floor reaction force instantaneous value and the provisional instantaneous value of the desired floor reaction 
force. In addition, the simplified model's body horizontal position correcting moment Mps and the simplified model' s 
body posture angle correcting moment Mrs are determined as correction quantities of the desired floor reaction force 

50 and additionally input to the simplified model 200, which is the first dynamics model. Then, inputs to the inverse full 
model 201 which is the second dynamics model are determined in terms of desired instantaneous values of the desired 
movement (corrected desired body horizontal position, corrected desired posture or the like). According to the twenty- 
fifth implementation , the corrected desired floor reaction force's moment and the corrected desired floor reaction force's 
horizontal component, which are outputs of the inverse full model 201 , are obtained as desired instantaneous values 

55 of the desired floor reaction force. Furthermore, as the processing by the second model input correctingmeans accord- 
ing to the twenty-seventh implementation, the correcting perturbation model's body horizontal position Xc and the 
correcting perturbation model's body posture angle Be are determined and additionally input to the inverse full model 
201 , which is the second dynamics model, as correction quantities for the desired movement. 
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[0731] According to the fourth embodiment, the perturbation model 201 for correcting the body horizontal position 
and the perturbation model 203 for correcting body posture angles, are used as perturbation models according to the 
twenty-eighth and twenty-ninth implementations, and the distributors 220 and 221 are used as distribution means. As 
floor reaction force manipulating quantities to be input to the distributors 220 and 221 , the output of the integrator 21 7a 

5 and the body posture angle correcting moment Mr are used. In addition, as required values of the floor reaction force 
manipulating quantities according lo the twenty-ninth and thirtieth implementations, the required value Mpfdmd of the 
body horizontal position stabilizing moment and the required value Mrtdmd of the body posture angle stabilizing moment 
are used. Furthermore, according to the thirty-sixth implementation, in particular the output of the integrator 217a is 
used as a first manipulating quantity component of the floor reaction force manipulating quantity, and the moment Mpf 

10 for stabilizing the perturbation model for correcting body horizontal positions and the moment Mpr for stabilizing the 
perturbation model for correcting body posture angles (which is equal to the body posture angle correcting moment 
Mr input to the distributor 220 in the fourth embodiment) are used as a second manipulating quantity component. 
[0732] The first correction quantity component according to the twenty-sixth implementation corresponds to the out- 
put of the integrator 21 7a, and the second correction quantity component corresponds to the body horizontalposition- 

15 stabilizing moment Mpf and the body posture angle stabilizing moment Mrf (which equals to Mr in the fourth embodi- 
ment). Furthermore : in the fourth embodiment, the required value Mpfdmd of the body horizontal position stabilizing 
moment and the required value Mrfdmd of the body posture angle stabilizing moment are used as required values of 
the correction quantities of the desired floor reaction force. In addition, as estimated values of the limitation-target 
quantities in the twenty-sixth implementation, the unlimited corrected desired floor reaction force's moment Min and 

20 the unlimited corrected desired floor reaction force's horizontal component Fin are determined by the Min calculator 
209 and the Fin calculator21 0, respectively, and as limitation-target quantities having been limited, the limited corrected 
desired floor reaction force' s moment Mltd and the limited corrected desired floor reaction force's horizontal component 
Fltd are determined by the limitation processor 211 . Besides, the "predetermined part" of the robot according to the 
thirty-second implementation refers to the body 24 of the robot 1 . 

25 [0733] The floor reaction force's moment used in the fourth embodiment may be appropriately converted into a ZM P 
using the desired floor reaction force's vertical component, as in the first embodiment. 

[0734] In addition, the thirty-fifth implementation involves no required value of the floor reaction force manipulating 
quantity, and the embodiment in this case can be provided by setting both the values Mpfdmd and Mprdmd in the fourth 
embodiment to 0. Thus, the embodiment concerning the thirty-fifth implementation and the implementation (s) based 
30 essentially thereon is provided. Associations of this embodiment with the thirty-fifth implementation or the like are the 
same as the associations concerning the fourth embodiment. 

[0735] Now, a fifth embodiment of the present invention will be described, in the functional block diagram (Figure 
58) for illustrating the gait correction method according to the third embodiment, the part defined by the dotted line 
(part excluding the Mrfdmd determination processor 21 9 and the Mpfdmd determination processor 21 8) constitutes a 
forward dynamics full model which receives the required value Mpfdmd of the body horizontal position stabilizing mo- 
ment, the required value Mrfdmd of the body posture angle stabilizing moment, the desired ZMP, the desired floor 
reaction force's vertical component, the desired foot position/posture, and a movement state of another part, such as 
the desired arm posture, and outputs the corrected desired body vertical position, the corrected desired body horizontal 
position, the corrected desired body posture angle, the corrected desired floor reaction force's moment (about the 
desired ZMP) and the corrected desired floor reaction force' s horizontal component. Thus, this model is referred to 
as a pseudo forward dynamics full model and denoted by reference numeral 222. The pseudo forward dynamics full 
model 222 (that is, the part defined by the dotted line in Figure 58) is represented as a functional block having an input/ 
output relationship as shown in Figure 60. 

[0736] A gait correction method of a device according to the fifth embodiment uses the pseudo forward dynamics 
full model 222, rather than the inverse dynamics full model (inverse full model) 201 used in the first to fourth embodi- 
ments, as a forward dynamics full model. 

[0737] Figure 61 is a functional block diagram for illustrating an operation of the device according to the fifth embod- 
iment, specifically, the gait correction method in step S038 in the flowchart in Figure 13. A simplifiedmodel 223 shown 
in Figure 61 is a second simplified model which is different from the simplified model 200 in the pseudo forward dynamics 
full model 222 according to this embodiment. The second simplified model 223, which has the same function as the 
simplified model 200 described above in this embodiment, is not simply a dynamics model but represents the process 
from steps S01 0 to S034 in Figure 1 3 described above, that is, calculation (determination) of the simplified model gait's 
instantaneous values. Therefore, in Figure 61 , the sections other than the simplified model 223 are associated with 
the processing in step S038. In actual, the simplified model 223 is required only to determine the instantaneous values 
of the body posture angle and the body horizontal position, and is not necessarily required to perform all the processings 
from step S0 1 0 to step S034 in Figure 34. 

[0738] In the fifth embodiment, the points other than the processing in step S038 are the same as those in the first 
embodiment, and therefore, descriptions thereof are omitted. In the following, the processing in step S038 will be 
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described in detail with reference to Figure 61 . 

[0739] In the fifth embodiment, as shown in Figure 61, the gait generation device 100 has the pseudo forward dy- 
namics full model 222 and the second simplified model 223. and the differences of body horizontal position and body 
posture angle between a gait generated using the second simplified model 223 and a gait calculated using the pseudo 

5 forward dynamics full model 222 are determined by the calculators 224 and 225. Then, in accordance with the differ- 
ences, the required value Mpfdmd of the body horizontal position stabilizing moment and the required value Mrfdmd 
of the body posture angle stabilizing moment are determined according to a feedback control law, such as PID, in such 
a mannerthat these differences convergeto 0. That is, according to the control law 226 for stabilizing the body horizontal 
position, which is a feedback control !aw : the value Mpfdmd is determined in accordance with the difference between 

10 the body horizontal position determined by the simplified model 223 and the body horizontal position determined by 
the pseudo forward full model 222. Furthermore, according to the control law 227 for stabilizing the body posture angle, 
which is a feedback control law. the value Mrfdmd is determined in accordance with the difference between the body 
posture angle determined by the simplified model 223 and the body posture angle determined by the pseudo forward 
full model 222. Then, the determined values Mpfdmd and Mrfdmd are fed back to the pseudo forward dynamics full 

15 model and input thereto. That is, instead of the outputs of the Mpfdmd determining processor 218 and the Mrfdmd 
determining processor 219 according to the third embodiment shown in Figure 58, the output (Mpfdmd) of the control 
law 226 for stabilizing the body horizontal position and the output (Mrfdmd) of the control law 227 for stabilizing the 
body posture angle, respectively, are input to the pseudo forward full model 222 represented by the part defined by 
the dotted line in Figure 58. 

20 [0740] Furthermore, as the final desired instantaneous values for the current time gait, the gait generation device 
100 outputs the desired ZMP, the desired floor reaction force's vertical component, the desired foot position/posture, 
the desired arm posture and the like, which are inputs to the pseudo forward dynamics full model 222, and the corrected 
desired body vertical position, the corrected desired body horizontal position, the corrected desired body posture angle, 
the corrected desired floor reaction force's horizontal component and the corrected desired floor reaction force's mo- 

25 ment, which are outputs from the pseudo forward dynamics full model. 

[0741] Now, associations of the fifth embodiment described above with the present invention will be described. The 
fifth embodiment is associated with the fortieth and forty-first implementations of the present invention. While the fifth 
embodiment is associated with the forty-second implementation , this will be described later. The allowable range setting 
means according to the fortieth and forty-first implementations is associated with the processings in steps S030 and 

30 S036 in the flowchart in Figure 13, and, regarding the translation floor reaction force's horizontal component and the 
ZMP (true ZMP) as limitation-iarget quantities, the allowable ranges thereof are set. In addition, the desired floor re- 
action force provisional instantaneous value determining means according to the fortieth and forty-first implementations 
is associated with part of the processing in step S032 in the flowchart in Figure 13 (specifically, processings in steps 
S900 and S902 in Figure 37, that is, calculation of the instantaneous values of the desired floor reaction force's vertical 

-35 component and the desired ZMP). In addition, the second model calculation means according to the fortieth and forty- 
second implementations is associated with the calculation for the pseudo forward full model 222 in Figure 61 described 
above, that is, the processing performed by the section defined by the dotted line in Figure 58 described concerning 
the third embodiment. In addition, the first model calculation means according to the fortieth and forty-second imple- 
mentations is associated with the processing of the simplified model 223 in Figure 61 described above. Both the models 

40 222 and 223 output the body posture angle and the body horizontal position as the provisional instantaneous values 
for the desired movement. Since the pseudo forward full model 222 performs the processing for the part defined by 
the dotted line in Figure 58 described concerning the third embodiment, the floor reaction force's moment and the floor 
reaction force's horizontal component output from the pseudo forward full model 222 fall within their respective allowable 
ranges. In addition, the manipulating quantity calculation means according to the fortieth and forty-first implementations 

45 is associated with the processings of the control law 227 for stabilizing the body posture angle and the control law 226 
for stabilizing the body horizontal position in Figure 61 described above, and according to the control laws 227 and 
226, the required value Mrfdmd of the body posture angle stabilizing moment and the required value Mpfdmd of the 
body horizontal position stabilizing moment are determined as floor reaction force manipulating quantities. Furthermore, 
the model input correcting means according to the fortieth and forty-first implementations is associated with additional 

50 input of the values Mrfdmd and Mpfdmd to the pseudo forward full model 222, which is a second dynamics model, in 
the fifth embodiment. Besides, the "predetermined part" of the robot according to the forty-first implementation refers 
to the body 24 of the robot 1 . 

[0742] In the fifth embodiment, the value Mpfdmd is determined using the body horizontal position. However, the 
value Mpfdmd may be determined by bringing close to 0 the difference between the centers of gravity of the robot 1 
55 determined by the pseudo forward full model 222 and the simplified model 223 according to a feedback control law, 
such as a PI control law. In addition, the floor reaction force's moment used in the fourth embodiment may be appro- 
priately converted into a ZMP using the desired floor reaction force's vertical component, as in the first embodiment. 
[0743] Furthermore, the fifth embodiment is associated with the forty-second implementation of the present invention . 
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The forty-second implementation is based essentially on the twenty -sixth implementation associated with the third 
embodiment, and the third model calculation means according to the forty-second implementation is associated with 
the processing of the simplified model 223 in Figure 61 described above. And, the values Mrfdmd and Mpfdmd deter- 
mined by the control law 227 for stabilizing the body posture angle and the control law 226 for stabilizing the body 

5 horizontal position, respectively, are used as required value in the forty-second implementation. 

[0744] Besides the fifth embodiment, there are various types of methods using the forward dynamics full model 
(forward full model) . such as one previously proposed by the applicants in Japanese Patent Application No. 
2001 -122621 . If. for each of these methods, the full model is replaced with the pseudo forward dynamics full model, 
and a control law for stabilizing the body posture angle is additionally provided, there can be provided a full model 

10 correction method which takes the ZMP allowable range and the floor reaction force's horizontal component allowable 
range into consideration. 

[0745] Generally speaking, a method using a forward dynamics full model is such a method that uses a forward 
dynamics full model and a simplified model and determines the differences of body horizontal position and/or body 
posture angle between the gaits generated using the simplified model and the forward dynamics fuil model. Then, 
15 based on at least one of the determined differences, a manipulating quantity is determined so as to make the difference 
converge to 0, the manipulating quantity is fed back (input) to at least one of the simplified model and the forward 
dynamics full model, and a gait containing the input and output of the forward dynamics full model is generated as a 
corrected gait. 

[0746] As the pseudo forward full model 222. instead of the full model gait generation device (gait correction method) 

20 according to the third embodiment, one according to another embodiment may be used. However, in the case where 
the perturbation models 202 and 203 are used (first, second and fourth embodiments), there is a possibility that dis- 
placements in the perturbation models 202 and 203 be excessive. In such a case, each time generation of a gait for 
one step (current time gait) is completed, the displacements in the perturbation models 202 and 203 may be added to 
the simplified model 200 to initialize the perturbation models 202 and 203. 

25 [0747] In addition, the manipulating quantity (required value Mpfdmd of the body horizontal position stabilizing mo- 
ment or manipulating quantity to be fed back to the simplified model 200) may be determined based on the difference 
of center-of-gravity horizontal position, rather than the difference of body horizontal position. Alternatively, the manip- 
ulating quantity may be determined based on both the difference of body horizontal position and the difference of 
center-of-gravity horizontal position. 

30 [0748] As a dynamics model of the robot 1 for determining the normal gait parameters for generating the simplified 
model gait, determining the current-time gait parameters or generating the instantaneous values for the current time 
gait (that is, a process of receiving a variable concerning the floor reaction force, such as the desired ZMP and gen- 
erating a body position or posture that satisfies the dynamical equilibrium condition or a limitation condition concerning 
the allowable value of the floor reaction force's horizontal component or the like) , the pseudo forward dynamics full 

35 model may be used. In this case, if the required value Mpfdmd of the moment for stabilizing the body horizontal position 
is set to 0. the moment about the desired ZMP is 0. 

[0749] This allows the instantaneous values for the gait at each point in time that satisfy the dynamical equilibrium 
condition and the limitation condition to be calculated without using a searching method, and thus, the amount of 
calculation is reduced significantly. 
40 [0750] One of the floor reaction force's horizontal component allowable range and the ZMP allowable range may be 
neglected or eliminated (that is, the allowable range and the processing in the limitation processor 211 related to the 
allowable range may be omitted), or one of the allowable ranges may be set so wide that it can substantially be ne- 
glected. 

[0751 ] Furthermore, the allowable ranges may be varied with the condition of the floor surface or the gait mode. 

45 [0752] For example, when the robot walks on a slippery floor surface, the floor reaction force horizontal allowable 
range is set narrow, and the ZM P allowable range is set wide or neglected, thereby generating a gait that avoids slipping. 
[0753] Besides, when the robot ascends (descends) stairs with a narrow depth or walks on tiptoe (with a small floor- 
contact surface), the floor reaction force's horizontal component allowable range is set wide or neglected, and the ZMP 
allowable range is set narrow, thereby generating a gait having a high stability margin. 

50 [0754] When the robot runs, as in the embodiments described above, the floor reaction force's horizontal component 
allowable range has to be appropriately set in accordance with the floor reaction force's vertical component. 
[0755] According to the detailed description of the limiter means ( limitation processor 211), in the embodiments 
described above, the ZMP allowable range is set separately for the back-and-forth direction (X-axis direction) and the 
sideward direction (Y-axis direction) for the simplicity of calculation. However, if the ZMP allowable range is represented 

55 by relational formulas for the back-and-forth direction (X-axis direction) and the sideward direction in accordance with 
the supporting polygon, a more appropriate gait with a higher stability margin can be generated. For example, the ZMP 
allowable range may be represented by simultaneous inequalities comprising one or more inequalities as follows. 
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a1 1 * X component of ZMP + a12 * Y component of ZMP + a13 > 

0 

a21 * X component of ZMP + a22 * Y component of ZMP 4- a23 > 

0 formula 300 

w [0756] In this formula, characters a11 and the like denote constants. 

[0757] Accordingly, the allowable range of the floor reaction force's moment for the corrected gait is represented by 
simultaneous inequalities, instead of the formula 33. 

[0758] Furthermore, in the embodiments described above, the floor reaction force's horizontal component allowable 
range is also set separately for the back-and-forth direction (X-axis direction) and the sideward direction (Y-axis direc- 
ts tion) forthe simplicity of calculation. However again, if the floor reaction force's horizontal component allowable range 
is represented by relational formulas for the back-and-forth direction and the sideward direction, a gait that avoids 
slipping can be generated. 

[0759] For example, the allowable range may be a so-called friction circle as described by the following formula. 

20 

(X component of floor reaction force's horizontal component) 

* (X component of floor reaction force's horizontal component) 
25 + (Y component of floor reaction force's horizontal component) 

* (Y component of floor reaction force's horizontal component) 

< (ka * * Fz) * (ka * * Fz) formula 301 

30 

[0760] Here, Fz denotes the desired floor reaction force's vertical component, denotes a friction coefficient, and 
ka denotes a positive constant equal to or smaller than t . 

[0761] However, in the case where the ZMP allowable range and the floor reaction force's horizontal component 
allowable range are represented by the relational formulas forthe back-and-forth direction and the sideward direction 
35 as described above, the movement on the sagittal plane and the movement on the lateral plane have to be determined 
in parallel so as to satisfy the allowable ranges simultaneously or alternately. 

[0762] In gait generation using the simplified model 200, the floor reaction force's horizontal component allowable 
range may be neglected or set so wide that it can substantially be neglected. In this case, there is no need to vary the 
body posture angle to avoid exceeding the floor reaction force's horizontal component allowable range, and thus, the 

40 desired body posture angle generated can be kept agreeing with the reference body posture angle (target of conver- 
gence of the desired body posture angle). This prevents the behavior of the body posture angle from being complicated, 
and therefore, the behavior can be readily predicted, and the gait parameters (not diverging) that assure gait generation 
using the simplified model 200 and continuous stability of the gait can be readily determined. The simplified model gait 
generated in this way may be an unstable one that doesn't adequately satisfy the dynamical equilibrium condition or 

45 one that easily causes slipping. However, as described above, the gait can be corrected using the full model 201 or 
222 to provide a gait with a higher stability margin that avoids slipping. 

[0763] Furthermore, when the floor reaction force's vertical component is small, the simplified model 200 may be 
adapted to primarily satisfy the floor reaction force's horizontal component allowable range, neglecting the desired 
ZMP. For example, for the floating period in the running gait, the gait may be generated by assuring simply that the 
so total center-of -gravity horizontal acceleration is 0, neglecting the floor reaction force's moment about the desired ZMP. 
As in the embodiments described above, the simplified model gait generated in this way can also be corrected using 
the full model 201 or 222 to provide a gait with a higher stability margin which avoids slipping. 

[0764] For the perturbation model 202 for correcting body horizontal positions, the translation force's vertical com- 
ponent of the resultant force of gravity and the inertia! force applied to the legs 2, 2 can be approximated by gravity 
55 applied to the legs 2, 2, neglecting the inertial force applied thereto. 

[0765] In the embodiments described above, the body material particle for the perturbation model 202 for correcting 
body horizontal positions makes a vertical movement in accordance with the body floor reaction force's vertical com- 
ponent Fbz. However, the vertical position of the body material particle may be approximated by a constant height by 
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neglecting the vertical movement of the body material particle. This is because, in running, the variation of (vertical) 
distance between the body position and the floor is typically 10% or lower. However, in this case also, the behavior of 
the perturbation model 202 for correcting body horizontal positions is preferably determined assuming that a virtual 
vertical constraint force in balance with the body floor reaction force's vertical component Fbz is applied to the body 

5 material particle in the perturbation model 202 for correcting body horizontal positions. 

[0766] In the process of generating the simplified model gait according to the embodiments described above, the 
body posture restoring moment ZMP-converted value ZMPrec. which is the ZMP-converled value of the body posture 
restoring moment that produces the body posture angle acceleration for returning the body posture angle to its initial 
value, is generated. However, the algorithm for calculating the moment may be used as the control law for the pertur- 

w bation model forcorrecting body posture angles, and the calculated moment may be used as the required value Mrfdmd 
of the body posture angle stabilizing moment. 

[0767] Incidentally, the body posture restoring moment or the body posture restoring moment ZMP-converted value 
(ZMPrec) is generated in a pattern of a previously determined function (time function), such as a trapezoidal pattern 
as described above, when the floor reaction force's horizontal component allowable range and the ZMP allowable 

15 range (floor reaction force's moment allowable range) are sufficiently wide. Therefore, the body posture restoring mo- 
ment or the body posture restoring moment ZMP-converted value is used, as it is, as the moment Mrf for stabilizing 
the perturbation model forcorrecting body posture angles (body posture angle stabilizing moment Mrf) without being 
limited by the limiter means and serves to vary the body posture angular acceleration of the simplified model. In addition, 
unlike normal linear feedback, convergence of the body posture angle doesn't take infinitetime, and by generating an 

20 appropriate ZMPrec pattern, the body posture angle can be settled to a reference or desired body posture angle in a 
finite time. 

[0768] As for the control law for the perturbation model for correcting body horizontal positions, as with the determi- 
nation of the body posture restoring moment in the generation process of the simplif iedmodei gait described above, 
the required value Mpfdmd of the moment for stabilizing the body horizontal position may be generated in a pattern of 

25 a previously determined function (time function), such as a trapezoidal pattern , when the floor reaction force's horizontal 
component allowable range and the ZMP allowable range (floor reaction force's moment allowable range) are suffi- 
ciently wide. Therefore, the required value Mpfdmd of the moment for stabilizing the body horizontal position is used, 
as it is, as the moment Mpf for stabilizing the perturbation model forcorrecting body horizontal positions (body horizontal 
position stabilizing moment Mpf) without being limited by the limiter means and serves to vary the body horizontal 

30 acceleration of the simplified model 200. 

[0769] Instead of integration (integrators shown in the block diagrams) used in gait correction, another feedback 
control law, such as PI control, may be used. 

[0770] For example, as the control law for converging the full-model's floor reaction force's moment error Merr to 0, 
another control law, such as PI control, may be used instead of the integrator 217a. 

35 [0771] Similarly, as a control law that receives a value obtained by subtracting the full-model's floor reaction force's 
horizontal component Ffull from the limited corrected desired floor reaction force's horizontal component Fltd and 
outputs a product of the inverse number of the body translation mode floor reaction force ratio h and the moment Mpf 
for stabilizing the perturbation model forcorrecting body horizontal positions, another control law, such as PI control, 
may be used instead of the integrator 215a. 

40 [0772] The gains used in the embodiments described above, for example, the gain Km of the integrator 21 7a, the 
gain Kc of the integrator 21 5a, or gains of feedback control laws, such as the control law 206 for the perturbationmodel 
for correcting body horizontal positions, may not be a constant value. For example, the gains may be varied in accord- 
ance with the floor reaction force's horizontal component allowable range, the ZMP allowable range, the point in time 
in the gait or the like. 

45 [0773] If the body translation mode floor reaction force ratio h cannot be determined in an analysis manner as shown 
by the formula a14, returning to the definition of the formula a7, the acceleration of the body horizontal position Xb in 
the dynamics model is brought into slight perturbation, and a ratio between the perturbations of the floor reaction force's 
moment My and the floor reaction force's horizontal component Fx is determined and the ratio may be adopted as the 
body translation mode floor reaction force ratio h. 

50 [0774] Alternatively, although the precision is slightly reduced, the average of the values of the body translation mode 
floor reaction force ratio h for a standard gait is previously determined, and the average value may be used. 
[0775] In the above description, when the unlimited corrected desired floor reaction force's moment Min doesn't fall 
within the floor reaction force's moment allowable range or unlimited corrected desired floor reaction force's horizontal 
component Fin doesn't fall within the floor reaction force's horizontal component allowable range, the limiter means 

55 (limitation processor 211) determines the values Fltd and Mltd so as to satisfy the formulas 35, 36. 37, 38 and 41, to 
provide a value AMp2 with a minimum absolute value and to provide a value AF with a minimum absolute value. 
However, the following formula 111 may be used instead of the formula 41 . Here, character c denotes a predetermined 
value. 
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AM - AF * c + AMp2 formula 1 1 1 

[0776] As the value c becomes larger exceeding the body translation mode floor reaction force ratioh, the correcting 
5 perturbation model's body horizontal position is more preferentially stabilized than the correcting perturbation model's 
body posture angle. 

[0777] In the second, third and fourth embodiment, since the full-model's floor reaction force's moment Mfuil sub- 
stantially agree with the limited corrected desired floor reaction force's moment Mltd, the limited corrected desired floor 
reaction force's moment Mltd may be output as the corrected desired floor reaction force's moment, instead of the full- 

10 model's floor reaction force's moment Mfull. 

[0778] In addition, since the full-model's floor reaction force's horizontal component Ffull substantially agrees with 
the limited corrected desired floor reaction force's horizontal component Fltd, the limited corrected desired floor reaction 
force's horizontal component Fltd may be output as the corrected desired floor reaction force's horizontal component, 
instead of the full-model' s floor reaction force's horizontal component Ffull. 

15 [0779] In the first to fourth embodiments, the simplified model 200 is used to generate the gait instantaneous values 
to be input to the inverse full model 201 to correct the gait However the gait may be corrected by inputting a table 
concerning the gait to the full model. 

[0780] As a method of calculating, in the limiter means (limitation processor 211), the unlimited corrected desired 
floor reaction force's horizontal component Fin and the moment Mpf for stabilizing the perturbation model for correcting 

20 body horizontal positions (body horizontal position stabilizing moment) from the required value Mpfdmd of the correcting 
perturbation model stabilizing moment (required value of the body horizontal position stabilizing moment), the full- 
model's floor reaction force's horizontal component Ffull, the moment Mpf for stabilizing the perturbation model for 
correcting body horizontal positions (body horizontal position stabilizing moment) . the full-model's floor reaction force's 
horizontal component Ffull, the limited corrected desired floor reaction force's horizontal component Fltd and the like, 

25 a method of estimating a bias estimated value may be used which is proposed in the PCT patent application (named 
"control system" and related to a limitation function) filed by the applicants on December 24, 2002. This method and 
the method performed in the limiter means in embodiments of the present invention can be approximately replaced 
with each other as described in the PCT patent application. 

[0781 ] The corrected desired body vertical position may be determined in such a manner that the difference between 
30 the desired total center-of-gravity vertical position that satisfies the desired floor reaction force's vertical component 
and the total center-of- gravity vertical position of the full model gait (full-model total center-of -gravity vertical position) 
converges to 0. 

[0782] A process of determining the corrected desired body vertical position according to the method is shown in 
the functional block diagram in Figure 62. Now, with reference to Figure 62, this process will be described. Using the 

35 full model, the total center-of-gravity vertical position (referred to as a full-model total center-of-gravity vertical position, 
hereinafter) is determined based on the instantaneous values of the corrected gait. In addition, the difference between 
the desired total center-of-gravity vertical position that satisfies the desired floor reaction force's vertical component 
and the full-model total center-of-gravity vertical position determined as described above (full-model total center-of- 
gravity vertical position difference) is multiplied by a predetermined gain Kgz, and the resulting value is integrated to 

40 calculate a height correction value. Then, the body vertical position determined using the simplified model is multiplied 
by a predetermined feed forward gain Kffgz, and the sum of the resulting value and the height correction value is 
determined as the full-model's body vertical position (that is, the corrected desired body vertical position). 
[0783] The feed forward gain Kffgz is a predetermined value ranging from 0 to 1 . The corrected desired body vertical 
position may be determined by assuming the feed forward gain Kffgz is 0, that is, without taking into consideration the 

45 simplifiedmodel gait's body vertical position. In this case, the height correction value agrees with the corrected desired 
body vertical position. 

[0784] Since the floor reaction force's vertical component is proportional to the sumof the total center-of-gravityver- 
tical acceleration and the gravitational acceleration of the robot 1, a parameter concerning the total center-of-gravity 
vertical acceleration trajectory of the robot 1 may be explicitly set as a gait parameter, instead of the floor reaction 

50 force's vertical component trajectory. The two are substantially the same. Furthermore, instead of the floor reaction 
force's vertical component trajectory, a parameter concerning the vertical acceleration trajectory of a part whose be- 
havior resembles that of the total center-of-gravity trajectory of the robot 1 may be set explicitly. For example, in the 
case where the mass of the legs 2, 2 is adequately smaller than the mass of the body 24, the body vertical acceleration 
trajectory and the total center-of-gravity vertical acceleration trajectory of robot 1 are substantially the same or propor- 

55 tional to each other. Therefore, the body vertical acceleration trajectory may be used instead of the floor reaction force's 
vertical component trajectory. 

[0785] Similarly, since floor reaction force's horizontal component and the total center-of-gravity horizontal acceler- 
ation of the robot are proportional to each other, the total center-of-gravity horizontal acceleration of the robot and the 
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allowable range thereof may be used instead of the floor reaction force's horizontal component and the allowable range 
thereof in the embodiments described above. Furthermore, a parameter concerning the horizontal acceleration trajec- 
tory of a part whose behavior resembles that of the total center-of-gravity horizontal trajectory of the robot may be set 
expticitly. For example, in the case where the mass of the legs 2, 2 is adequately smaller than the mass of the body 
5 24 ; the body horizontal acceleration trajectory and the total center-of-gravity horizontal acceleration trajectory of the 
robot 1 are substantially the same or proportional to each other. Therefore, the body horizontal acceleration and the 
allowable range thereof may be used instead of the floor reaction force's horizontal component and the allowable range 
thereof. 

[0786] Furthermore, in gait generation when the robot 1 moves on an inclined surface, instead of the floor reaction 
10 force's horizontal component allowable range and the allowable range of the total center-of-gravity acceleration's hor- 
izontal component, the allowable range of a floor-surface-parallel component (component parallel to the floor surface) 
of the translation floor reaction force, that is, the allowable range of the friction force, or the allowable range of a 
component parallel to the floor surface of the total center-of-gravity acceleration (which is proportional to the friction 
force if the gravitational component thereof is excluded) may be set. For example, as for a case of setting the allowable 
15 range of the floor-surface-parallel component of the translation floor reaction force (friction force) (the same holds true 
for a case of setting the allowable range of the floor-surface-parallel component of the total center-of-gravity acceler- 
ation), assuming that the inclination angle of the floor surface with respect to the horizontal surface is denoted by 6f 
(where Of is positive when the surface is inclined downwardly in the travel direction of the robot), the friction force is 
represented by the following formula c72. Thus, in the case where a gait is generated according to the same algorithm 
20 as that in the embodiments described above, the friction force allowable range is converted into the floor reaction 
force's horizontal component allowable range using the formula c72, thereby setting the floor reaction force's horizontal 
component allowable range. In this case ; as the floor reaction force's vertical component in the formula c72, the desired 
floor reaction force's vertical component may be used. 



25 

friction force - floor reaction force's horizontal component 
* cos (Gf) - floor reaction force's vertical component * sin 
30 Bf) formula c72 



[0787] In order for the floor reaction force's horizontal component and the floor reaction force's moment about the 
desired ZMP to have adequate values, two movement modes, that is, the body rotation mode and the body translation 
mode are used in the embodiments described above. However, another movement mode may be used. 
[0788] For example, as shown in Figure 63, if the body posture is rotated about the hip joint of the robot 1 , the total 
center of gravity, as well as the angular momentum about the total center of gravity, varies. Combining (synthesizing) 
this movement with the movement in the body translation mode by a predetermined ratio results in substantially the 
same movement in the body rotation mode, and no floor reaction force's horizontal component occurs. Therefore, if 
this mode is regarded as the body rotation mode, a gait similar to those in the embodiments described above can be 
generated according to the algorithm in the embodiments. 

[0789] Therefore, there is no need to have at least one movement mode that produces no floor reaction force's 
horizontal component. This is because any floor reaction force's horizontal component and floor reaction force's mo- 
ment about the desired ZMP can be produced for any combination of movement modes as in the example described 
above, as far as the two movement modes produce the floor reaction force's horizontal component and the floor reaction 
force's moment about the desired ZMP in different ratios. 

[0790] In addition, a movement mode concerning something other than body posture may be used. However, a 
movement mode should be chosen in which a minimum displacement produces a large floor reaction force's horizontal 
component or floor reaction force's moment about the desired ZMP 

[0791] For example, a movement mode in which the left and right arms are swung in the same rotational direction, 
or a movement mode in which the position of a foot not in contact with the floor (floating in the air) is brought into 
perturbation may be used. However, in the case where the free leg trajectory is brought into perturbation, the amount 
of perturbation should be reduced to approximately 0 by the time immediately before landing to avoid varying the 
landing position, 

[0792] Alternatively, three or more movement modes may be used. 

[0793] In this case, at least two of the chosen movement modes have to be ones that produce the floor reaction 
force's horizontal component and the floor reaction force's moment about the desired ZMP in different ratios. Otherwise, 
in general, the simultaneous equations would have no solutions. 

[0794] Furthermore, preferably, a movement mode that varies the floor reaction force's moment about the desired 
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ZMP significantly and doesn't vary so largely the floor reaction force's horizontal component is combined with a move- 
ment mode that varies the floor reaction force's horizontal component significantly and doesn't vary so largely the floor 
reaction force's moment about the desired ZMP. 

[0795] In other words, preferably, a movement mode that varies the angular momentum adequately and doesn't vary 
5 so largely the total center of gravity is combined with a movement mode that varies the total center of gravity adequately 
and doesn't vary so largely the angular momentum. This is because the displacements of the movement modes are 
reduced. 

[0796] As the simplified model described above, models other than the dynamics models used in the embodiments, 
such as those described below, may be used. 

10 

1) A nonlinear model in which material particles are provided for a plurality of links as shown in Figure 12 (multi- 
mass model). 

2) A three-material-particle model disclosed in Japanese Patent Application No. 2000-352011 filed by the appli- 
cants 

15 3) A one-material particle model in which only the body has a mass. 

4) A model which neglects the moment of the inertial force caused by an angular momentum variation about the 
total center of gravity. 

5) A separate-type model which has a partial model representing a relationship between the resultant force of 
gravity and the inertial force (or the floor reaction force) and the body translation movement and a partial model 

20 representing a relationship between the resultant force and the body rotation movement. For example, the material 

particles shown in Figure 11 constitute the partial model representing a relationship between the resultant force 
and the body translation movement, and the flywheel shown in Figure 1 1 constitutes the partial model representing 
a relationship between the resultant force and the body rotation movement. 

25 [0797] As a full model, in principal, a dynamics model having a higher approximation precision higher than the sim- 
plified model is preferably used. However, a dynamics model having an approximation precision nearly equal to that 
of the simplified model may be used. 

[0798] In addition, the processings involved in generation of the simplifiedmodel gait may be performed using only 
one model, or different models may be used forthe different processings involved in generation of the simplified model 

30 gait. For example, since the normal gait is generated only to determine the final state of the current time gait, the 
required dynamics precision of the normal gait is lower than that of the current time gait. Therefore, for example, while 
the simplified model (model consisting of three material particles and a flywheel) shown in Figure 11 is used in gener- 
ation of the current time gait, in generation of the normal gait (in particular, steps S408 and S412 in Figure 22), a 
dynamics model which consists of the body material particle 24m corresponding to the body 24 and the flywheel FH, 

35 neglecting the masses of the legs 2, 2 (that is, a model consisting of one material particle and a flywheel, which results 
from eliminating the leg material particles 2m, 2m from the model in Figure 11) may be used. In generation of the 
normal gait in this case, in the embodiments described above, the processings in steps S408 and S412 in Figure 22 
are performed assuming that the mass of the leg material particles 2m, 2m is 0. This allows calculation amount involved 
in the normal gait generation to be significantly reduced. 

40 [0799] In the embodiments described above, the block diagrams, the flowcharts and the algorithms may be altered 
into equivalent ones by changing the sequence of calculations. In addition, a low-pass filter may be inserted appropri- 
ately. 

[0800] While the embodiments of the present invention has been described concerning a two-legged mobile robot, 
the present invention can be applied to a legged robot having three or more legs. 

45 

Industrial Applicability 

[0801] As described above, the present invention is effective in generating a gait with which a legged mobile robot, 
such as a two-legged mobile robot, can move smoothly in a variety of gait modes. 

50 

Claims 

1. A gait generation device for generating a desired gait for a legged mobile robot that moves by operating a plurality 
55 of legs extending from a body, comprising: 

allowable range setting means for setting an allowable range of a limitation-target quantity, the limitation-target 
quantity being at least any of a horizontal component of a translation floor reaction force or a floor-surface- 
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parallel component of a translation floor reaction force applied to the robot or a horizontal component of a total 
center-of-gravity acceleration or a floor-surface-parallel component of a total center-of-gravity acceleration of 
the robot and a floor reaction force moment or a ZMP; 

provisional instantaneous value determining means for determining provisional instantaneous values of a de- 
sired movement and a desired floor reaction force of said desired gait; 

model calculating means that inputs at least the provisional instantaneous value of said desired movement to 
a dynamics model to determine a model floor reaction force instantaneous value as an output of the dynamics 
model, the dynamics model representing a relationship between a movement and a floor reaction force of said 
robot; and 

desired instantaneous value determining means for correcting the provisional instantaneous value of said 
desired movement to determine a desired instantaneous value of the desired movement based on at least the 
difference between the model floor reaction force instantaneous value and the provisional instantaneous value 
ofsaid desiredfloor reaction force and said allowable range, 

wherein the desired instantaneous value determining means corrects the provisional instantaneous value of 
said desired movement in such a manner that said limitation-target quantity which corresponds to the instantaneous 
value of the floor reaction force substantially in balance with, in said dynamics model, the resultant force of an 
inertial force and gravity applied to the robot caused by the desired instantaneous value of the desired movement 
falls within said allowable range. 

The gait generation device for a legged mobile robot according to claim 1, wherein model floor reaction force 
instantaneous values determined by said model calculating means include at least a model value of the floor 
reaction force moment or the ZMP, provisional instantaneous values of said desired floor reaction force determined 
by said provisional instantaneous value determining means include at least a provisional desired instantaneous 
value of the floor reaction force moment or the ZMP, and said difference used by said desired instantaneous value 
determining means is the difference between said model value of the floor reaction force moment or the ZMP and 
the provisional desired instantaneous value of the floor reaction force moment or the ZMP. 

The gait generation device for a legged mobile robot according to claim 1, wherein said desired instantaneous 
value determining means determines, as the desired instantaneous value of the desired floor reaction force, the 
instantaneous value of the floor reaction force substantially in balance with, in said dynamics model, the resultant 
force of an inertial force and gravity applied to the robot caused by the desired instantaneous value of the desired 
movement. 

The gait generation device for a legged mobile robot according to claim 1 , wherein said desired instantaneous 
value determining means comprises: 

a perturbation model that represents a relationship between a perturbation movement and a perturbation floor 
reaction force of said robot; 

means for determining a perturbation model manipulating quantity for manipulating the perturbation floor re- 
action force of said perturbation model based on at least said difference and said allowable range; 
means for determining a correction quantity for said desired movement by inputting the determined perturba- 
tion model manipulating quantity to said perturbation model; and 

means for determining a desired instantaneous value of said desired movement by correcting the provisional 
instantaneous value of said desired movement with the correction quantity. 

The gait generation device for a legged mobile robot according to claim 4, further comprising: 

means for determining a required value of said perturbation model manipulating quantity in accordance with 
at least a state quantity of said perturbation model, 

wherein said means for determining a perturbation model manipulating quantity determines the perturbation 
model manipulating quantity to be input to said perturbation model based on said difference, said allowable range 
and said required value. 

The gait generation device for a legged mobile robot according to claim 5, further comprising: 

means for successively determining the required value of said perturbation model manipulating quantity ac- 
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cording to a feedback control law in accordance with a deviation of said state quantity of the perturbation model 
from a desired value of the state quantity. 

The gait generation device for a legged mobile robot according to claim 4, wherein said perturbation model is a 
model that involves a plurality of perturbation movements having different perturbation ratios between the horizontal 
component of the translation floor reaction force and the floor reaction force moment to said perturbation movement, 
said perturbation model manipulating quantity comprises a plurality of kinds of manipulating quantity associated 
with the respective perturbation movements, and said correction quantity for the desired movement comprises a 
plurality of kinds of correction quantity associated with the respective perturbation movements. 

The gait generation device for a legged mobile robot according to claim 7, wherein said plurality of perturbation 
movements comprise a translation movement of the body of said robot and a posture varying movement in which 
the posture of a predetermined part of the robot is varied while keeping the center of gravity of the robot substantially 
unchanged. 

The gait generation device for a legged mobile robot according to claim 7, wherein said plurality of perturbation 
movements comprise a translation horizontal movement of the body of said robot and a posture varying movement 
of the body of the robot. 

The gait generation device for a legged mobile robot according to claim 7, wherein said limitation-target quantity 
is composed of a horizontal component of a translation floor reaction force or a floor-surface-parallel component 
of a translation floor reaction force applied to the robot or a horizontal component of a total center- of- gravity ac- 
celeration or a floor-surface-parallel component of a total center-of-gravity acceleration of the robot and a floor 
reaction force moment or a ZMP. 

The gait generation device for a legged mobile robot according to claim 4, wherein said perturbation model ma- 
nipulating quantity comprises a first manipulating quantity component that is determined according to at least said 
difference and a second manipulating quantity component that is determined based on at least said allowable 
range, and 

said means for determining a perturbation model manipulating quantity comprises: 

means for determining an estimated value of said limitation-target quantity corresponding to the desired in- 
stantaneous value of the desired movement that is determined if only said first manipulating quantity compo- 
nent is input to said perturbation model; 

means for determining a limited iimitation-target quantity by comparing the determined estimated value of the 
limitation-target quantity with said allowable range and limiting the limitation-target quantity within the allowable 
range based on the result of comparison; and 

means for determining said second manipulating quantity component based on at least the limited limitation- 
target quantity. 

The gait generation device for a legged mobile robot according to claim 5, wherein said perturbation model ma- 
nipulating quantity comprises a first manipulating quantity component that is determined according to at least said 
difference and a second manipulating quantity component that is determined based on at least said required value 
and said allowable range, and 

said means for determining a perturbation model manipulating quantity comprises: 

means for determining an estimated value of said limitation-target quantity corresponding to the desired in- 
stantaneous value of the desired movement that is determined if said second manipulating quantity component 
which is made to agree with said required value and said first manipulating quantity component are input to 
said perturbation model; 

means for determining a limited limitation -target quantity by comparing the determined estimated value of the 
limitation-target quantity with said allowable range and limiting the limitation-target quantity within the allowable 
range based on the result of comparison; and 

means for determining said second manipulating quantity component based on at least the limited limitation- 
target quantity. 

The gait generation device for a legged mobile robot according to claim 11 or 12, wherein said limitation-target 
quantity comprises the horizontal component of the translation floor reaction force or the floor-surface-parallel 
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component of the translation floor reaction force or the horizontal component of the total center-of-gravity accel- 
eration or the floor-surface-parallel component of the total center-of-gravity acceleration of the robot, and 

said means for determining a perturbation model manipulating means determines the estimated value of 
said limitation-target quantity using, as saidmodel floor reaction force instantaneous value, the instantaneous value 
5 of the horizontal component of the translation floor reaction force or the instantaneous value of the floor-surface- 

parallel component of the translation floor reaction force determined by said dynamics model. 

14. The gait generation device for a legged mobile robot according to claim 12, wherein said perturbation model is a 
model that involves a translation movement of the body of the robot and a posture varying movement of the body 

1 o of the robot said limitation-target quantity comprising the horizontal component of the translation floor reaction 

force or the floor-surface-parallel component of the translation floor reaction force applied to the robot or the hor- 
izontal component of the total center-of-gravity acceleration or the floor-surface-parallel component of the total 
center-of-gravity acceleration of the robot and the floor reaction force moment or the ZMP, and 

said means for determining a limited limitation-target quantity determines each limited I imitation -target quan- 

15 tity in such a manner that the variation of a manipulation quantity component of said second manipulating quantity 

component which is associated with said body posture varying movement from said required value is reduced to 
a minimum, and the variation of the limited limitation-target quantity from said estimated value is reduced to a 
minimum. 



15. The gait generation device for a legged mobile robot according to claim 11 or 12, wherein said desired instanta- 
neous value determining means determines the floor reaction force associated with said limited limitation-target 
quantity as the desired instantaneous value of said desired floor reaction force. 



16. The gait generation device for a legged mobile robot according to claim 1, characterized in that said desired 
25 instantaneous value determining means comprises: means for additionally inputting a correction quantity for cor- 
recting the provisional instantaneous value of said desired movement to said dynamics model; and 

means for determining said correction quantity in such a mannerthat said I imitation -target quantity associated 
with said model floor reaction force instantaneous value is substantially kept at a value within said allowable range 
and said difference is stabilized. 

30 

17. The gait generation device for a legged mobile robot according to claim 4, wherein said desired instantaneous 
value determining means comprises means for additionaliy inputting a correction quantity for said desired move- 
ment to said dynamics model, and said perturbation mode! manipulating quantity comprises a first manipulating 
quantity component that is determined according to at least said difference and a second manipulating quantity 

35 component that is determined based on at least said allowable range, and 

said means for determining a perturbation model manipulating quantity comprises: 

means for determining an estimated value of said limitation-target quantity corresponding to the model floor 
reaction force instantaneous value that is output from said dynamics model if only said first manipulating 
40 quantity component is input to said perturbation model; 

means for determining a limited limitation-target quantity by comparing the determined estimated value of the 
limitation-target quantity with said allowable range and limiting the limitation-target quantity within the allowable 
range based on the result of comparison; and 

means for determining said second manipulating quantity component based on at least the limited control- 
's target quantity. 



18. The gait generation device for a legged mobile robot according to claim 5, wherein said desired instantaneous 
value determining means comprises means for additionally inputting a correction quantity for said desired move- 
ment to said dynamics model, and said perturbation model manipulating quantity comprises a first manipulating 
quantity component that is determined according to at least said difference and a second manipulating quantity 
component that is determined based on at least said required value and said allowable range, and 
said means for determining a perturbation model manipulating quantity comprises: 

means for determining an estimated value of said limitation-target quantity corresponding to the model floor 
reaction force instantaneous value that is output from said dynamics model if said second manipulating quantity 
component which is made to agree with said required value and said first manipulating quantity component 
are input to said perturbation model; 

means for determining a limited limitation-target quantity by comparing the determined estimated value of the 



101 



BNSDOCID: <EP 1473122A1J > 



EP 1 473 122 A1 



limitation-target quantity with said allowable range and limiting the limitation-target quantity within the al lowable 
range based on the result of comparison; and 

means for determining said second manipulating quantity component based on at least the limited control- 
target quantity. 

5 

19, The gait generation device for a legged mobile robot according to claim 1 7 or 1 8, wherein said second manipulating 
quantity components include said floor reacLion force moment or the ZMP and said differences include at least the 
difference concerning the floor reaction force moment or ZMP, and 

said means for determining a perturbation model manipulating quantity comprises means for determining 
10 said first manipulating quantity component in such a manner that the floor reaction force moment or ZMP con- 

cerning said differences is substantially equal to the floor reaction force moment or ZMP of said second manipu- 
lating quantity components. 

The gait generation device for a legged mobile robot according to claim 17 or 18, wherein said limitation-target 
quantity comprises the horizontal component of the translation floor reaction force or the floor-surface-paralle! 
component of the translation floor reaction force or the horizontal component of the total center-of-gravity accel- 
eration or the floor-surface-parallel component of the total center-of-gravity acceleration of the robot, and 

said means for determining a perturbation mode! manipulating quantity means determines the estimated 
value of said limitation-target quantity using, as said model floor reaction force instantaneous value, the instanta- 
neous value of the horizontal component of the translation floor reaction force or the instantaneous value of the 
floor-surface-parallel component of the translation floor reaction force determined according to said dynamics 
model. 

The gait generation device for a legged mobile robot according to claim 18, wherein said perturbation model is a 
model that involves a translation movement of the body of the robot and a posture varying movement of the body 
of the robot, said I imitation -target quantity comprising the horizontal component of the translation floor reaction 
force or the floor-surface-parallel component of the translation floor reaction force applied to the robot or the hor- 
izontal component of the total center-of-gravity acceleration or the floor-surface-parallel component of the total 
center-of-gravity acceleration of the robot and the floor reaction force moment or the ZMP, and 

said means for determining a limited limitation-target quantity determines each limited limitation-target quan- 
tity in such a manner that the variation of a manipulation quantity component of said second manipulating quantity 
components which is associated with said body posture varying movement from said required value is reduced to 
a minimum, and the variation of the limited limitation-target quantity from said estimated value is reduced to a 
minimum. 

The gait generation device for a legged mobile robot according to claim 16, wherein said desired instantaneous 
value determining means determines said model floor reaction force instantaneous value as the desired instanta- 
neous value of said desired floor reaction force. 

23. A gait generation device for generating a desired gait for a legged mobile robot that moves by operating a plurality 
of legs extending from a body, comprising: 

allowable range setting means for setting an allowable range of a I imitation -target quantity, the limitation-target 
quantity being at least any of a horizontal component of a translation floor reaction force or a floor- surf ace- 
parallel component of a translation floor reaction force applied to the robot or a horizontal component of a total 
center-of-gravity acceleration or a floor-surface-parallel component of a total center-of-gravity acceleration of 
the robot and a floor reaction force moment or a ZMP; 

desired floor reaction force's provisional instantaneous value determining means for successively determining, 
of a desired movement and a desired floor reaction force of said desired gait, at least a provisional instanta- 
neous value of the desired floor reaction force; 

first model calculating means that inputs at least the provisional instantaneous value of the desired floor re- 
action force to a first dynamics model to determine a provisional instantaneous value of the desired movement 
as an output of the first dynamics model, the first dynamics model representing a relationship between a 
movement and a floor reaction force of said robot; 

second model calculating means that inputs at least the provisional instantaneous value of said desired move- 
ment to a second dynamics model to determine a model floor reaction force instantaneous value as an output 
of the second dynamics model, the second dynamics model representing a relationship between a movement 
and a floor reaction force of said robot; and 
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first model input correcting means that determines a correction quantity of said desired floor reaction force 
based on at leastthe difference between the model floor reaction force instantaneous value and the provisional 
instantaneous value of said desired floor reaction force and said allowable range in such a manner that said 
limitation-target quantity corresponding to saidmodel floor reaction force instantaneous value that is output 
from said second dynamics model falls within said allowable range and additionally inputs the determined 
correclion quantity to said first dynamics model 



wherein 

the desired instantaneous value of said desired movement is determined based on at least the input to said 
second dynamics model. 



24. Tho gait generation device for a legged mobile robot according to claim 23 ; wherein model floor reaction force 
instantaneous values determined by said second model calculating means include at least a model value of the 
floor reaction forcemoment or the ZMP, theprovisional instantaneous values of said desired floor reaction force 
15 determined by said provisional instantaneous value determining means include at least a provisional desired in- 

stantaneous value of the floor reaction force moment orthe ZMP, and said difference used by said first model input 
correcting means is the difference between said model value of the floor reaction force moment or the ZMP and 
the provisional desired instantaneous value of the floor reaction force moment or the ZMP. 

20 25. The gait generation device for a legged mobile robot according to claim 23, wherein said desired instantaneous 
value determining means determines said model floor reaction force instantaneous value output from said second 
dynamics model as the desired instantaneous value of said desired floor reaction force. 

26. The gait generation device for a legged mobile robot according to claim 23, further comprising: 

25 

means for determining a required value of the correction quantity of said desired floor reaction force, 

wherein the correction quantity of said desired floor reaction force determined by said first model input cor- 
recting means comprises a first correction quantity component that is determined according to at least said differ- 
30 ence and a second correction quantity component that is determined based on at least said required value and 

said allowable range ; 

said first model input correcting means comprises: 

means for determining an estimated value of said limitation-target quantity corresponding to the model floor 
35 reaction force instantaneous value that is output from said second dynamics model if said second correction 

quantity component which is made to agree with said required value and said first correction quantity compo- 
nent are additionally input to said first dynamics model; 

means for determining a limited limitation-target quantity by comparing the determined estimated value of the 
limitation-target quantity with said allowable range and limiting the I imitation -target quantity within the allowable 
40 range based on the result of comparison; and 

means for determining said second correction quantity component based on at least the limited limitation- 
target quantity. 

27. The gait generation device for a legged mobile robot according to claim 23, further comprising: 

45 

second model input correcting means that determines a correction quantity for said desired movement based 
on at least said difference and said allowable range, and additionally inputs the determined correction quantity 
to said second dynamics model. 



28. The gait generation device for a legged mobile robot according to claim 27, further comprising: 

a perturbation model that represents a relationship between a perturbation movement and a perturbation floor 
reaction force of said robot; 

means for determining a floor reaction force manipulating quantity based on at least said difference and said 
allowable range; and 

distributor means for separating the determined floor reaction force manipulating quantity into a correction 
quantity of said desired floor reaction force that is to be input to said first dynamics model and a perturbation 
model manipulating quantity that is to be input to said perturbation model, 
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wherein said second model input correcting means determines the correction quantity for said desired move- 
ment by inputting said perturbation model manipulating quantity to said perturbation model. 

29. The gait generation device for a legged mobile robot according to claim 28, further comprising: 

5 

means for determining a required value of said floor reaction force manipulating quantity in accordance with 
at least a state quantity of said perturbation model 

wherein said means for determining a floor reaction force manipulating quantity determines the floor reaction 
10 force manipulating quantity to be supplied to said distributor means based on said difference, said allowable range 

and said required value. 

30. The gait generation device for a legged mobile robot according to claim 29, further comprising; 

15 means for successively determining the required value of said floor reaction force manipulating quantity ac- 

cording to a feedback control law in accordance with a deviation of said state quantity of the perturbation model 
from a desired value of the state quantity 

31 . The gait generation device for a legged mobile robot according to claim 28. wherein said perturbation model is a 
20 model that involves a plurality of perturbation movements having different perturbation ratios between the horizontal 

component of the translation floor reaction force and the floor reaction force momentto said perturbation movement, 
said floor reaction force manipulating quantity comprises a plurality of kinds of manipulating quantity associated 
with the respective perturbation movements, and said correction quantity for the desired movement determined 
by said second model input correcting means comprises a plurality of kinds of correction quantity associated with 
25 the respective perturbation movements. 



32. The gait generation device for a legged mobile robot according to claim 31 , wherein said plurality of perturbation 
movements comprise a translation movement of the body of said robot and a posture varying movement in which 
the posture of a predetermined part of the robot is varied while keeping the center of gravity of the robot substantially 

30 unchanged. 

33. The gait generation device for a legged mobile robot according to claim 31 , wherein said plurality of perturbation 
movements comprise a translation horizontal movement of the body of said robot and a posture varying movement 
of the body of the robot. 

35 

34. The gait generation device for a legged mobile robot according to claim 31 , wherein said limitation-target quantity 
is composed of a horizontal component of a translation floor reaction force or a floor-surface-parallel component 
of a translation floor reaction force applied to the robot or a horizontal component of a total center-of-gravity ac- 
celeration or a floor-surface-parallel component of a total center-of-gravity acceleration of the robot and a floor 

40 reaction force moment or a ZMR 



35. The gait generation device for a legged mobile robot according to claim 28, wherein said floor reaction force ma- 
nipulating quantity comprises a first manipulating quantity component that is determined according to at least said 
difference and a second manipulating quantity component that is determined based on at least said allowable 

45 range, and 

said means for determining a floor reaction force manipulating quantity comprises: 

means for determining an estimated value of said limitation-target quantity corresponding to the model floor 
reaction force instantaneous value that is output from said second dynamics model if only said first manipu- 
50 lating quantity component is input to said distributor means; 

means for determining a limited limitation -target quantity by comparing the determined estimated value of the 
limitation-target quantity with said allowable range and limiting the limitation -target quantity within the allowable 
range based on the result of comparison; and 

means for determining said second manipulating quantity component based on at least the limited control- 
55 target quantity. 

36. The gait generation device for a legged mobile robot according to claim 29, wherein said floor reaction force ma- 
nipulating quantity comprises a first manipulating quantity component that is determined according to at least said 
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difference and a second manipulating quantity component that is determined based on at least said required value 
and said allowable range : and 

said means for determining a floor reaction force manipulating quantity comprises: 

5 means for determining an estimated value of said limitation-target quantity corresponding to the model floor 

reaction force instantaneous value thai is outpul from said second dynamics model if said second manipulating 
quantity component which is made to agree with said required value and said first manipulating quantity com- 
ponent are input to said distributor means; 

means for determining a limited limitation-target quantity by comparing the determined estimated value of the 
10 limitation-target quantity with said allowable range and limiting the limitation-target quantity within the allowable 

range based on the result of comparison; and 

means for determining said second manipulating quantity component based on at least the limited control- 
target quantity. 

15 37. The gait generation device for a legged mobile robot according to claim 35 or 36 ; wherein said second manipulating 
quantity components include said floor reaction force moment or the ZMP and said differences include at least the 
difference concerning the floor reaction force moment or ZMP and 

said means for determining a perturbation model manipulating quantity comprises means for determining 
said first manipulating quantity component in such a manner that, the floor reaction force moment or ZMP con- 

20 cerning said differences is substantially equal to the floor reaction force moment or ZMP of said second manipu- 

lating quantity components. 

38. The gait generation device for a legged mobile robot according to claim 35 or 36, wherein said limitation-target 
quantity comprises said horizontal component of the translation floor reaction force or the floor-surface-parallel 

25 component of the translation floor reaction force or the horizontal component of the total center-of-gravity accel- 

eration or the floor-surface-parallel component of the total center-of-gravity acceleration of the robot, and 

said means for determining a floor reaction force manipulating means determines the estimated value of 
said limitation-target quantity using, as said model floor reaction force instantaneous value, the instantaneous 
value of the horizontal component of the translation floor reaction force or the instantaneous value of the floor- 

30 surface-parallel component of the translation floor reaction force determined by said dynamics model. 

39. The gait generation device for a legged mobile robot according to claim 36, wherein said perturbation model is a 
model that involves a translation movement of the body of the robot and a posture varying movement of the body 
of the robot, said limitation-target quantity comprising the horizontal component of the translation floor reaction 

35 force or the floor-surface-paraliel component of the translation floor reaction force applied to the robot or the hor- 

izontal component of the total center-of-gravity acceleration or the floor-surface-parallel component of the total 
center-of-gravity acceleration of the robot and the floor reaction force moment or the ZMP, and 

said means for determining a limited limitation-target quantity determines each limited limitation-target quan- 
tity in such a manner that the variation of a manipulation quantity component of said second manipulating quantity 

40 components which is associated with said body posture varying movement from said required value is reduced to 

a minimum, and the variation of the limited limitation-target quantity from said estimated value is reduced to a 
minimum. 

40. A gait generation device for generating a desired gait for a legged mobile robot that moves by operating a plurality 
45 of legs extending from a body, comprising: 

allowable range setting means for setting an allowable range of a limitation-target quantity, the limitation-target 
quantity being at least any of a horizontal component of a translation floor reaction force or a floor-surface- 
parallel component of a translation floor reaction force applied to the robot or a horizontal component of a total 
center-of-gravity acceleration or a fioor-surface-parallel component of a total center-of-gravity acceleration of 
the robot and a floor reaction force moment or a ZMP; 
desired floor reaction force's provisional instantaneous value determining means for successively determining, 
of a desired movement and a desired floor reaction force of said desired gait, at least a provisional instanta- 
neous value of the desired floor reaction force; 
55 firs t model calculating means that inputs at least the provisional instantaneous value of the desired floor re- 

action force to a first dynamics model to determine a first provisional instantaneous value of the desired move- 
ment as an output of the first dynamics model, the first dynamics model representing a relationship between 
a movement and a floor reaction force of said robot; and 
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second model calculating means that inputs at least the provisional instantaneous value of said desired floor 
reaction force to a second dynamics model, which represents a relationship between a movement and a floor 
reaction force of said robot to determine a second provisional instantaneous value of the desiredmovement 
as an output of the second dynamics mode! in such a manner that said limitation-target quantity corresponding 

5 to the floor reaction force instantaneous value that is, in said second dynamics model, substantially in balance 

with the resulLant force of the inertial force and center-of-gravily applied to the robot caused by the second 
provisional instantaneous value of Lhe desired movement falls within said allowable range 
manipulating quantity calculating means for determining the floor reaction force manipulating quantity based 
on at least the difference between the first provisional instantaneous value and the second provisional instan- 

10 taneous value of said desired movement in such a manner that the difference is close to 0; and 

modal input correcting means for additionally inputting the floor reaction force manipulating quantity to at least 
any one of said first dynamics model and said second dynamics model, 

w herein the second provisional instantaneous value of said desired movement is determined as the desired 
15 instantaneous value of the desired movement. 

41 . The gait generation device for a legged mobile robot according to claim 40, wherein differences between the first 
provisional instantaneous value and the second provisional instantaneous value of said desired movement include 
a difference of the position of a predetermined part of said robot, or include a difference of the position of the center 

20 of gravity of the robot and a difference of the posture of a predetermined part of the robot. 

42. The gait generation device for a legged mobile robot according to claim 26, further comprising; 

third model calculating means that inputs at least the provisional instantaneous value ofsaid desiredfloor re- 
25 action force to a third dynamics model, which represents a relationship between a movement and a floor 

reaction force of said robot, to determine a third provisional instantaneous value of the desired movement as 
an output of the third dynamics model. 

wherein said means for determining a required value of the correction quantity of said desired floor reaction 
30 force determines said required value based on the difference between said determined desired instantaneous 

value of said desired movement and said third provisional instantaneous value of said desired movement in such 
a manner that the difference is close to 0. 
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FIG.l 
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FIG.5 

(RUNNING GAIT) 
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FIG.6 

( DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT ) 
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FIG.10 

{ BODY ROTATION MODE) 
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FIG.ll 

{ SIMPLIFIED MODEL WITH FLYWHEEL) 
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FIG.14 

{ DIVERGENCE STATE OF BODY POSITION ) 
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FIG.15 

( PROCESS OF DETERMINING NORMAL GAIT PARAMETER) 
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FIG.16 

(RELATIONSHIP AMONG FOOT LANDING POSITIONS/POSTURES FOR NORMAL GAIT) 
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FIG.17 

( DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT) 
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FIG.18 

( FLOOR REACTION FORCE'S HORIZONTAL COMPONENT ALLOWABLE RANGE ) 
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FIG.19 
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FIG.20 

( PROCESS OF SEARCHING FOR INITIAL DIVERGENCE COMPONENT FOR NORMAL GAIT ) 
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FIG.21 

(PROVISIONAL GAIT GENERATION PROCESS FOR NORMAL GAIT) 
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FIG.22 

(PROCESS OF DETERMINING NORMAL GAIT INSTANTANEOUS VALUE) 
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FIG.32 

( RELATIONSHIP AMONG BODY POSITIONS AT THE TIME OF LANDING FOR NORMAL GAIT I 
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FIG.33 

( PROCESS OF PROVISIONALLY DETERMINING CURRENT TIME GAIT PARAMETER ) 
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FIG.34 

( FLOOR REACTION FORCE'S HORIZONTAL COMPONENT ALLOWABLE RANGE ) 
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FIG.35 

( PROCESS OF CORRECTING CURRENT TIME GAIT PARAMETER IN SEARCHING MANNER ) 
C ENTRY ) 
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CALCULATE PROVISIONAL CURRENT TIME GAIT TO END TIME BASED ON PROVISIONAL 
DESIRED ZMP AND OTHER CURRENT TIME GAIT PARAMETERS 



S704 



DETERMINE FINAL DIVERGENCE COMPONENT qO[k] FROM BODY POSITION/VELOCITY 

(Xe, Ve) AT THE END OF CURRENT TIME GAIT USING FORMULA: 

qO[k] = Xe-f Vxe/a>0 



S7O0 



OO 



DETERMINE FINAL DIVERGENCE COMPONENT ERROR errq USING FORMULA: 
errq = qO[k] - q" 
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5708 YES — — — - — 
errq FALLS WITHIN ALLOWABLE RANGE? <C ( ^^^ 



S710 



CALCULATE PROVISIONAL CURRENT TIME GAIT TO END TIME BASED ON DESIRED 
ZMP OBTAINED BY CORRECTING PROVISIONAL DESIRED ZMP ACCORDING TO 
RELATIONSHIP SHOWN IN FIGURE 38 ON THE ASSUMPTION THAT o = A a 



BASED ON BODY POSITIONAELOCITY [Xel, Vxel) AT THE END OF CURRENT 
TIME GAIT WHICH IS RECALCULATED BASED ON CORRECTED DESIRED ZMP, 
DETERMINE FINAL DIVERGENCE COMPONENT q I [k] USING FORMULA: 
q1[k] = Xel +Vxel/a)0 
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DETERMINE PARAMETER SENSITIVITY r USING FORMULA: 
r = (qT[k]-qO[kj)/Ao 
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ADD CORRECTION QUANTITY DETERMINED ON THE ASSUMPTION OF a = -errq/r 
TO PROVISIONAL DESIRED ZMP TO RENEW PROVISIONAL DESIRED ZMP 
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DETERMINE BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN 
BASED ON DIFFERENCE BETWEEN FINAL BODY POSTURE ANGLE FOR PROVISIONAL 
CURRENT TIME GAIT AND INITIAL BODY POSTURE ANGLE FOR NORMAL GAIT AND 
DIFFERENCE BETWEEN FINAL BODY POSTURE ANGULAR VELOCITY FOR PROVISIONAL CURRENT 
TIME GAIT AND INITIAL BODY POSTURE ANGULAR VELOCITY FOR NORMAL GAIT 



DETERMINE, AS DESIRED ZMP PATTERN, PATTERN OBTAINED BY ADDING 
BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED 
VALUE PATTERN TO PROVISIONAL DESIRED ZMP PATTERN 



S720 



C RETURN ^ > 



133 



1473122A1_L> 



EP 1 473 122 A1 



FIG.36 

( PROCESS OF GENERATING PROVISIONAL CURRENT TIME GAIT ) 
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INITIALIZE 

PROVISIONAL GAIT GENERATION TIME k=0 
VALUES IN CURRENT TIME SUPPORTING LEG COORDINATE SYSTEM 
CONVERTED FROM FINAL STATE OF LAST TIME DESIRED GAIT IS USED 
AS INITIAL STATES OF CURRENT TIME GAIT 
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FIG.37 

( PROCESS OF DETERMINING CURRENT TIME PROVISIONAL GAIT INSTANTANEOUS VALUE ) 
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DETERMINE DESIRED FLOOR REACTION FORCE'S VERTICAL 
COMPONENT AT TIME k BASED ON GAIT PARAMETER 
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DETERMINE DESIRED ZMP AT TIME k BASED ON GAIT PARAMETER 
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DETERMINE DESIRED FEET POSITIONS/POSTURES, REFERENCE BODY POSTURE 
AND DESIRED ARM POSTURE AT TIME k BASED ON GAIT PARAMETER 
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CALCULATE TOTAL CENTER-OF-GRAVITY VERTICAL POSITION THAT SATISFIES 
DESIRED FLOOR REACTION FORCE'S VERTICAL COMPONENT 
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CALCULATE BODY VERTICAL POSITION THAT SATISFIES 
TOTAL CENTER-OF-GRAVITY VERTICAL POSITION 
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DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT 
ALLOWABLE RANGE [Fxmin, Fxmox] AT TIME k BASED ON GAIT PARAMETER 
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DETERMINE BODY HORIZONTAL ACCELERATION AND BODY POSTURE ANGULAR 
ACCELERATION FOR CURRENT TIME PROVISIONAL GAIT SO AS TO SATISFY DESIRED 
ZMP IN SUCH A MANNER THAT FLOOR REACTION FORCE'S HORIZONTAL COMPONENTl 
Fx DOESN'T EXCEED [Fxmin, Fxmax] 
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CALCULATE BODY HORIZONTAL VELOCITY AND BODY POSTURE ANGULAR 
VELOCITY BY INTEGRATING BODY HORIZONTAL ACCELERATION AND BODY 
POSTURE ANGULAR ACCELERATION AND INTEGRATES THE RESULTING VALUES 
TO DETERMINE BODY HORIZONTAL POSITION AND BODY POSTURE ANGLE 
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FIG.38 

( PROCESS OP DETERMINING BODY HORIZONTAL ACCELERATION 

AND BODY POSTURE ANGULAR ACCELERATION FOR CURRENT TIME GAIT) 
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DETERMINE BODY HORIZONTAL ACCELERATION a tmp THAT IS 
REQUIRED TO SATISFY CURRENT TIME (TIME k) DESIRED ZMP 
IN THE CASE WHERE ROBOT MOVES IN BODY TRANSLATION MODE 



SI 004 



DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fxtmp 
IN THE CASE WHERE BODY HORIZONTAL ACCELERATION IS a tmp 



S1006 Fxtmp > Fxmox 



Fxtmp 



Jxtmp < Fxmin 
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DETERMINE HORIZONTAL COMPONENT Fx 
OF FLOOR REACTION FORCE USING FORMULA: 
Fx = Fxmox 



Fx = Fxmin 



ELSE 



Fx = Fxtmp 
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S1012 



S10 



DETERMINE BODY HORIZONTAL ACCELERATION a IN BODY 
TRANSLATION MODE AND BODY ANGULAR ACCELERATION js 
IN BODY ROTATION MODE USING FORMULAS: 
a = a tmp + (Fx - Fxtmp)/ A Fp 

j8 = (atmp-arAMp/AMr 



YES 



SET BODY INCLINATION RESTORING MOMENT 
ZMP CONVERTED VALUE PATTERN 



SI 01 6 
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CALCULATE INSTANTANEOUS VALUE ZMPrec OF BODY INCLINATION 
RESTORING MOMENT ZMP CONVERTED VALUE PATTERN AT TIME k 



fi =-ZMPrec*Fz(k)/AMr 
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DETERMINE BODY HORIZONTAL ACCELERATION a tmp THAT IS 
REQUIRED TO SATISFY CURRENT TIME (TIME k) DESIRED ZMP IN THE 
CASE WHERE ROBOT MOVES ONLY IN BODY TRANSLATION MODE 



a = atmp-(AMr/AMp)*/9 
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DETERMINE FLOOR REACTION FORCE'S HORIZONTAL COMPONENT Fx 
IN THE CASE WHERE BODY HORIZONTAL ACCELERATION IS a 
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FIG.39 

( CORRECTION OF DESIRED ZMP ) 
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FIG.40 

(DESIRE FLOOR REACTION FORCE'S VERTICAL COMPONENT DURING WALKING) 
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FIG.43 

( PERTURBATION MODEL FOR CORRECTING BODY HORIZONTAL POSITIONS ) 

Z 

BODY MATERIAL PARTICLE HORIZONTAL POSITION Xc 

MDY MATERIAL PARTICLE { INVERTED 

PENDULUM 



FULCRUM 




HEIGHT OF 
INVERTED 
PENDULUM 



MATERIAL PARTICLE ) 



BODY MATERIAL 
PARTICLE VERTICAL 
POSITION Zc(=Zb) 



-► X 

DESIRED ZMP VERTICAL POSITION 



FIG.44 

(PERTURBATION MODEL FOR CORRECTING BODY POSTURE ANGLES) 
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FI6.45 

( SUPPORTING POLYGON AND ZMP ALLOWABLE RANGE) 
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FIG.46 

FLOOR REACTION FORCE'S MOMENT 



Mmax 



(Fltd,Mltd) = (Fin,Min) 



Fmi n 



Fmax 



Mmin 



FLOOR REACTION FORCE'S 
HORIZONTAL COMPONENT 



BOUNDARY OF ALLOWABLE RANGE 



FIG.47 

FLOOR REACTION FORCE'S MOMENT 



Fmin 
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FIG.49 

FLOOR REACTION FORCE'S MOMENT 
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FIG.53 
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